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Robotics! It is an exciting word, and well it should be. Manufacturing in much of the 
world is undergoing drastic changes because of robotics. More than ever before, 
there is a need for anyone interested in computers and/or electronics to learn about 
motor control, artificial intelligence, and other robotic-related subjects. The problem 
is where to obtain the desired information. 

Many serious books on robotics rely heavily on advanced mathematics and spe- 
clalized languages or seem to assume you have a Ph.D. They are so theoretical that it 
is hard to find something practical to apply to average situations. At the other ex- 
treme, there are numerous books aimed at a hobbyist with little, if any, background 
in electronics. Although these books examine down-to-earth projects, they usually 
offer very little educational instruction. They are not meant to do so. Their goal is to 
show you how to duplicate the author’s work in building a toy robot. These toys are 
very sophisticated in many cases, but that is not the point. Rather than just imitating 
my work, I want you to understand it so that you can first expand upon it, and then 
change it to meet your goals. Finally, I want you to combine the basic principles in 
new ways to create your own designs. 

Don’t misunderstand my reference to toys. I’m all for them, especially if they 
make learning more fun and less expensive. The projects in this book certainly fall 
into my definition of toys. And while it is true that I am going to show you how to 
construct them, I won’t stop there. Once a project is built, I will use it to examine 
principles found in robots costing a hundred, even a thousand times more than mine. 
These principles may not always relate directly to their industrial counterparts, but 
they will move you in a direction that will make more complicated ideas easier to 


grasp. 
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INDUSTRIAL VS. HOBBY ROBOTS 


If you have been reading any technical journals, or almost any magazine for 
that matter, you know that robotics is certainly the wave of the future. It is 
easy to think that robotics, which is just another way of saying computer- 
aided manufacturing, is going to totally revolutionize the world. And given 
enough time, it probably will. The era of the fully automated factory is cer- 
tainly on its way, but its arrival is still a few years off. This is especially true if 
our expectations include robots with vision and tactile senses that can adapt 
autonomously to meet the needs of a changing environment. 

It is very important that anyone interested in the technical sciences learn 
about robotics. Everyone doesn’t need to become an expert in every area of 
robotics, though. Robots of the future will have their own operating systems 
and become easier and easier to use. Even so, those persons that have a grasp 
of the fundamental principles of robotics will have an edge over those that do 
not. 

Robots that are used in manufacturing are very expensive. Fortunately, 
we can explore many of the fundamental principles of robotics using much 
less sophisticated equipment. Industrial robots are very fast and very ac- 
curate, which is what makes them very expensive. Most of the robots de- 
scribed in this book will sacrifice speed and accuracy to keep the cost down. 
And although I’m sure you would rather be experimenting with a $100,000 
arm, I think you will find my alternatives acceptable. 


WHAT 


2 Introduction 


My robots will be made from readily available parts. Appendix A lists 
some sources for robot parts in case you have trouble locating something. 
There is nothing special about my physical designs. They will be explained in 
detail so they can be easily duplicated, but don’t hesitate to adapt them to 
whatever materials you have available. 

Actually, the physical construction of my robots is very easy. Except for 
the final project, a man-sized arm, all of my designs are aimed only at 
demonstrating principles. They are not meant to perform actual work. As 
such, they do not require any special strength. This means that glue and simple 
hand tools can easily be substituted for welds and intricate machining. Most 
of the projects can be built for only a few dollars. The final project, as I men- 
tioned, is different. If you choose to spend a little more on its construction, it 
can easily be a dependable, practical, and very capable arm. The choice is 
yours, and you don’t need to decide now. There is a lot of exciting experimen- 
tation to do first. 


IS A ROBOT? 


Because of television and movies, many people assume that a robot is made up 
of mystical internal parts that somehow create super intelligence. The me- 
chanical construction of a robot is very straightforward. A robot is nothing 
more than a physical structure whose movement is controlled by one or more 
computers. The computer software is the most important part of any robot 
and probably the least understood. The majority of this book is devoted to 
improving your understanding of this software. 

Most of the programs will be in BASIC, not because it is necessarily the 
best-suited language for robot experimentation, but because nearly everyone 
interested in this book will be familiar with it. Don’t take the software por- 
tions of this book lightly. They hold the key to most of the understanding. 

Naturally, software cannot operate in a vacuum. It must interface with 
the hardware in many ways. The first type of interfacing that comes to mind is 
controlling the power source that moves the robot. Typically, a robot is 
moved by DC motors, stepper motors, hydraulics, or pneumatics. As you 
would expect, my budget-minded experiments will use only motors. I will 
show you how the computer can turn a motor on and off. You will learn how 
to control the motor’s speed and position. We will examine different types of 
feedback and see how robot arms relate to both open and closed loop control 
systems. 

Once a motor’s position can be established, I will show you how simple 
geometry can relate the motor’s position to the position of the hand or manip- 
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ulator. We will then examine how software can determine where the hand 
needs to be positioned. As our robot arm becomes more intelligent, we will see 
how feedback sensors and vision can be used to allow interaction between the 
robot and its environment. 


NOT ALL WORK 


We’re also going to have some fun. I will show you howto build a very special 
arm—an arm that can manipulate a hand puppet. Under control of your 
computer, the puppet can talk and move as you wish. You will be amazed at 
how lifelike it will appear. Actually, the puppet project is not all games. It can 
give some insight into how your local pizza place provides its mechanical 
entertainment. 

I will also provide programs that can simulate a robot arm on your TV 
screen. Simulations will allow us to see how an arm will react to the controlling 
program before it is actually built. We can discover problems and design flaws 
before it’s too late to change them easily. Using simulations, you can learn a 
lot of principles quickly and with a minimum of effort. In fact, in order to get 
you involved sooner in the exciting parts of robotics, I’m going to begin my 
presentation with a simulated arm. 


A Simulsted 
X-¥ Arm 


WHY A SIMULATION? 


Rather than begin our experiments with a project that requires a lot of 
physical preparation, we will start by examining a simulated X-Y arm. Since it 
is a video simulation of a robot, I will refer to it as a videobot. Using the 
videobot, we can explore some of the principles of artificial intelligence. First 
however, let’s look at the requirements of the simulation. 

The major purpose of the arm is to create a three-dimensional world con- 
taining blocks that can be moved about by the make-believe arm. In order to 
keep this first project simple, the blocks can be placed only in certain spots. 
The usable space in our blocks world is an 8-by-8 grid that is three blocks 
deep. Figure 2.1 shows how the video screen will represent our videobot. 

At present, there are only three blocks (red, green, and blue) available to 
be manipulated. I will show you later how to increase this number if you wish. 
For now, let’s see how these three blocks are represented. There are three 
views of the area where the blocks reside. The top view shows blocks as if you 
were looking down on them. There is, for example, a blue block at location 
45. The number 45 means four blocks over and five blocks down. There is a 
red block at 81 and a green block at 67. 

You can also see each of these blocks in the front view and in the end 
view. In addition to the colored blocks, an additional block can be seen in 
each of the views. This block, which appears white on the screen, represents 
the hand. The commands N, S, E, and W will move the hand north, south, 
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| BLUE | 


GREEN 


|BLUE] GREEN] |. RED | 


Figure 2.1 The Apple screen represents the three-dimensional world of the video- 
bot. 


east, and west relative to the top view. You can think of the hand as being a 
very strong electromagnet or perhaps a suction device like a vacuum cleaner. 
When the arm is given the command pick-up (P), it will pull any block under it 
up tothe hand. Arelease command (R) will drop the block at the present hand 
position. 

There are several other features of the videobot, but you will appreciate 
them more if you can see them on your own screen. If you purchased a 
diskette (See Appendix B) with your copy of Robotics, then boot it on your 
Apple and RUN X-Y VIDEO SIMULATOR. If you do not have the diskette, 
type in the simulation program at the end of this chapter (Figure 2.2). 


THE ARM 


When first run, the simulator will give you a summary of commands and wait 
for your input. Initialize the videobot by typing the character J. The program 
will respond by drawing the arm as shown in Figure 2.1. The blocks are in col- 
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or. If you are using a black and white monitor you will have to remember 
which block is which on your own. 

The hand starts out at position 11. If you try to move the hand either 
north or west, it is kept from moving by the side wall. Try to move it in those 
directions by typing Nor W,, and it will print a J on the screen to indicate that 
it is jammed. 

Now use the south and east commands (S, £) to move the hand until it is 
above the blue block. As the hand moves, the program prints the direction 
moved to confirm that it was executed properly. Once you are over the blue 
block, type a Pto pick it up. You will see the blue block rise and be held by the 
hand. Also notice that when the hand picks up a block, the color of that block 
is printed. This gives our videobot a sort of limited vision. 

Move the hand east twice so that it is directly behind the green block. 
Now release (R) the blue block. As the block descends, you will see it pass 
behind the green block in the front view. An E will be printed to show the 
hand is empty. Pick up and release the blue block several times to observe 
these actions. The videobot program constantly calculates which blocks can 
be seen in each view and updates the screen accordingly. This will be true no 
matter how many blocks are used. 

Experiment a little with the simulator. Try stacking blocks ontop of each 
other and note how they are shown in the three-dimensional representation. 
When you feel comfortable with the operation of the X-Y simulation, turn to 
the end of this chapter to see the actual program (Figure 2.2). 

The simulation program is a subroutine starting on line 50000. Since the 
program is meant to be used as a tool rather than as an experiment in itself, I 
will not discuss its internal operation. It is well commented, though, in case 
you wish to examine it in detail. 

A short program is all that is needed to control the arm manually. This 
program uses the variable CM$ to pass commands to the videobot and to 
receive responses in return. It consists primarily of lines 110 through 130. 
These lines input your command, execute the videobot subroutine, and print 
the response. 

Now that you understand how the videobot can be controlled manually, 
turn to Chapter 3 and see how a program can intelligently direct the arm to 
perform high-level tasks. 
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10 REM /!---------<----------- ] 
20 REM ! x-yY SIMULATION ! 
30 REM ! OF A 3 BLOCK ! 
40 REM ! WORLD t 
45 REM ! BY JOHN BLANKENSHIP! 
30 REM ! THE COMMANDS ARE: ! 
60 REM ! I = INITIALIZE | 
70 REM ! N -—- MOVE NORTH ! 
71 REM ! 8 - MOVE SOUTH ! 
72 REM ! E - MOVE EAST t 
73 REM ! W - MOVE WEST ! 
74 REM ! P -—- PICK UP BLOCK ! 
73 REM ! DIRECTLY BELOW |! 
76 REM ! R —- RELEASE BLOCK ! 
77 REM ! ---------+----+---+----- ! 
78 REM ! CMs I8 USED TO ! 
79 REM !| PASS COMMANDS AND ] 
80 REM |! RETREIVE STATUS ! 
81 REM !---------------+------ ! 
82 REM ! STATUS SIGNALS ARE } 
83 REM ! N 8S E W —- AFTER A ! 
84 REM ! MOVE COMMAND ! 
85 REM ! TO CONFIRM ! 
86 REM ! J —- JAMMED AFTER A ! 
87 REM ! MOVE COMMAND ! 
88 REM ! RED GREEN BLUE - ! 
89 REM ! INDICATES BLOCK! 
90 REM ! PICKED UP AFTER! 
91 REM ! A ‘P* COMMAND ! 
92 REM ! E —- AFTER A '‘P' ! 
93 REM $$! MEANS EMPTY ! 
94 REM !---------- ----+------- ! 
100 HOME 
101 LIST 1,77 
105 VTAB 22 
106 PRINT "I-INITIALIZE FIRST" 
110 PRINT “ENTER COMMAND (N,8S,E,.W,P,R,1) 
;: GET CMS$ 
120 GOSUB 30000 
1253 PRINT "STATUS RETURNED = "CMS 
126 PRINT 
130 GOTO 110 
30000 REM ! ---------------+--+- ! 
30001 REM |! VIDEOBOT ! 
30002 REM ! A VIDEO ROBOT ! 
30003 REM ! COPYRIGHT 6/82 ! 
530004 REM |! BY ! 
$0005 REM ! JOHN BLANKENSHIP |! 
$0006 REM !{------------------ ! 
530010 IF CM$ =» "N” THEN 31000 
30020 IF CM¢@¢ = "8S" THEN 32000 
30030 IF CM6 =» "E" THEN 33000 
30040 IF CM6 = "W" THEN $4000 
$0030 IF CM6 w= "P" THEN 35000 
30060 IF CMS = "RR" THEN 36000 
$0070 IF CM$® w» "I" THEN 37000 
530080 PRINT "ERROR": STOP 
$1000 REM !—---------------- ] 
31001 REM ! MOVE ARM NORTH $! 
$1009 REM !---------------- t 
531010 GOSUB 31500: REM CAN WE MOVE 


X-Y VIDEO SIMULATOR 


Figure 2.2, X-Y VIDEO SIMULATOR 
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IF NOT YES THEN CMS 2» "J": RETURN 
TT = O: IF HD ¢ > O THEN TT = 1 
IF HD < > © THEN SBL(EZ,YY - 1,3) = 
HD: BL(xx,YY,3)> = O 
GOSUB 31600: REM FIND BC 
IF HD <¢ > O© THEN PT = 3: GOSUB 5170 
0: REM FIND RF,RT 
XT =» (XX - 1) *® 3 + 1 
FOR II =» 2 TO Q STEP - 1 
COLOR= WHITE 
YT =» (YY =- 1) *® 3 + II 
HLIN XT,XT + 2 AT ¥T = 2 
HLIN 27,28 + TTY AT ¥T —- 2 
IF HD = 0 THEN $1130 
COLORe RT 
HLIN 30,32 AT Y¥T =—- 2 
COLOR= BC 
HLIN XT,XT + 2 AT ¥T + 1 
COLORs BLACK 
HLIN 27,29 AT YT + 1 
IF HD = 0 THEN 51195 
COLOR= RF 
HLIN 30,32 AT Y¥T + 1 
NEXT II 
YY = YY - 1 
RETURN 
REM ! -~------------+-+-+-+----+ ' 
REM ! CAN WE MOVE NORTH |! 
REM !------------------- | 
YES = 0O 
IF ¥Y = 1 THEN RETURN 
IF HD = 0 THEN YES = 1: RETURN 
IF BL(CXX,Y¥Y -—- 1,3) s O THEN YES #® 1: 
RETURN 
RETURN 
REM !------------------+-+---- ! 
REM ! FIND BACKGROUND COLOR ss! 
REM ! OF CURSOR (BC) ! 
REM #23 ee ' 
BC = 0O 
FOR II » 3 TO 1 STEP - 1 
IF BLCOXX,YY,II) ¢ > O THEN BC = BL‘ 
XxX,YY,I1I>: RETURN 
NEXT II 
RETURN 
REM ! ---------------- 2-2 ---- ! 
REM ! FIND COLORS FOR RIGHT ! 
REM ! FROM & TO (NORTH ) 1 
REM !-------—---------------- ! 
RF z= O:RT = O 
FOR II = 8 TO 1 STEP - 1 
IF BLC(CII,.YY - 1,3) ¢ > O THEN RT = 
BLCII,YY¥Y =- 1,3): GOTO 3175350 
NEXT II 
FOR II = 8 TO 1 STEP - 1 
IPF BL(CII,YY,3)> < > O THEN RF «® BL(I 
I1,¥¥,3): GOTO 51780 
NEXT II 
RETURN 
REM !---------------- ' 
REM ! MOVE ARM SOUTH ! 
REM (-—----=------------ ! 
GOSUB 32500 
IF NOT YES THEN CMS = "J": RETURN 
TT w=» O: IF HD < > O THEN TT = 1 
IF HD <¢ > @© THEN BLCXX,.YY + 1,3) s 


532027 


Figure 2.2 (cont.) 
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HD: BLC(X&xX,YY,3)> = O 
32030 GOSUB 51600 
$2040 IF HD <¢ > O THEN PT = 3: GOSUB 3270 
0 
320530 XT = (X¥X¥ - 19 *® 3 + 1 
32060 FOR II = 0 TO 2 
52070 COLOR= WHITE 
32080 YT =» ¢¥¥Y - 10 * 393 + If #+ 3 
532090 HLIN XT,XT + 2 AT YT + 1 
32095 HLIN 27,28 + TT AT ¥T + 1 
532100 IF HD = 0 THEN 32130 
$2110 COLOR=s RT 
32120 HLIN 30,32 AT YT + 1 
32130 COLORs BC 


532140 HLIN XT,XT + 2 AT YT -—- 2 
532150 COLOR=s BLACK 
32160 HLIN 27,29 AT YT - @ 


$2170 IF HD = O THEN 52195 

52180 COLOR= RF 

$2190 HLIN 30,32 AT YT - 2 

52195 NEXT II 

52196 YY = ¥Y + 1 

52200 RETURN 

$2500 REM | <<46 s6sec5c605 tensa ' 

52501 REM ! CAN WE MOVE SOUTH |! 

$2505 REM 1-4-6266 ss2584505% ' 

52510 YES = 0 

$2520 IF YY = 8 THEN RETURN 

$2530 IF HD = O THEN YES = 1: RETURN 

$2540 IF BL(XX,YY + 1,3) = O THEN YES = 1 

52550 RETURN 

$2700 REM {( —_s eee eeee eee eee newts i 

52701 REM ! FIND COLORS FOR RIGHT ! 

$2702 REM ! FROM & TO (SOUTH) |! 

S2705 HEM. (4<2-e22<42466225225=2e5 { 

52710 RF = O:RT = O 

$2720 FOR II = 8 TO 1 STEP - 1 

$2730 IF BLC(II,YY + 1,3) ¢ > O THEN RT = 
BLCII,YY + 1,3): GOTO 52750 

52740 NEXT II 

52750 FOR II = 8 TO 1 STEP - 1 

$2760 IF BLC(II,¥Y,3) < > O THEN RF = BL(I 
1,¥Y¥,3): GOTO 51780 

$2770 NEXT II 

52780 RETURN 

SS006 REM: foeqdneeceae sce. ! 

53001 REM ! MOVE ARM EAST | 

53009 REM (-2==-4-2---+--4 ' 

53010 GOSUB 53500 

53020 IF NOT YES THEN CM8 = "J": RETURN 

$3025 TT = 0: IF HD <¢ »> O THEN TT = 1 

$3027 IF HD <« »> O THEN BL(XX + 1,Y¥Y,3) »= 
HD: BL(XX,YY,3) = 0 

$3030 GOSUB 51600 

$3040 $IF HD < »> O THEN PT = 3: GOSUB 5370 
0 

$3050 YT « (YY - 1) * 3 + 1 

$3060 FOR II = 0 TO 2 

$3070 COIOR= WHITE 

$3080 XT = (XX - 1) *®* 3 + II + 3 

53090 VLIN ¥T,¥T + 2 AT XT + 1 

$3095 VLIN 27,28 + TT AT XT + 1 

53100 IF HD = 0 THEN 53130 

$3110 COLOR= BT 

$3120 VLIN 30,32 AT XT + 1 


$3130 COLOR=s BC 


Figure 2.2 (cont.) 
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$3770 
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94025 
534027 


34030 
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VLIN YT,YT + 2 AT XT -—- 2 
COLORs BLACK 

VLIN 27,29 AT XT —- 2 

IF HD = 0 THEN 33195 
COLOR= SBF 


VLIN 30,32 AT XT —- 2 
NEXT II 

XX w= XX + 1 

RETURN 

REM /!----—-----------=- = --! 
REM ! CAN WE MOVE EAST ! 
REM (| ------------+------+ ! 
YES 0 


IF XX = 8 THEN 
IF HD = 0 THEN YES = 1: 


RETURN 
RETURN 


IF BLCZX + 1,YY,3)> = O THEN YES = 1 


RETURN 
REM Ve-—seeeceeSnso— si dees ! 
REM ! FIND COLORS FOR BOTTOM |! 
REM | FROM & TO (EAST) |! 
REM feo =-s6e5-4 see eee eee i 
BF = 0:BT = 0 

FOR II = 8 TO 1 STEP - 1 


IF BLCXX + 1,11,3) ¢ > O THEN BT = 


BLCXX + 1,11,3): GOTO 33750 


NEXT II 


FOR 


II =» 86 TO 1 STEP - 1 


IF BLCXX,11,3) ¢ > © THEN BF = BL(CX 


X,11,3%9: GOTO 33780 


NEXT II 
RETURN 


REM 
REM 
REM 


! MOVE ARM WEST ! 


GOSUB 34500 


IF NOT YES THEN CM6 = "J": RETURN 
TT = 0: IF HD < > O THEN TT = 1 
IF HD < > O THEN BL(XKX - 1,YY,3) « 


HD: BL(XX,YY,3> = O 


GOSUB 51600 


IF HD <¢ > O© THEN PT =» 3: GOSUB 5470 
YT = (YY - 1) *® 3 + 1 

FOR II = 2 TO 0 STEP - 1 

COLOR= WHITE 

ZT =» (3X - 1) *® 3 + II 

VLIN YT,YT + 2 AT XT - 2 

VLIN 27,28 + TT AT XT ~— 2 


IF HD = 0 THEN 34130 
COLOR= BT 

VLIN 30,32 AT XT -—- 2 
COLORs BC 

VLIN Y¥T,YT + 2 AT XT + 1 
COLOR= BLACK 

VLIN 27,29 AT XT + 1 

IF HD = 0 THEN 54195 
COLOR=s= SBF 

VLIN 30,32 AT XT + 1 


NEXT II 

XX = XX - 1 

RETURN 

REM !------------------ ! 
REM ! CAN WE MOVE WEST ! 
REM | -----------"------- ! 
YES 0 


IF XxX w= 1 THEN 


RETURN 


Figure 2.2 (cont.) 
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34330 IF HD = 0 THEN YES = 1: RETURN 

343540 IF BLC(CEX - 1,¥YY¥,3)> s 0 THEN YES = 1: 
RETURN 

$4350 RETURN 

534700 REM ! ------------------------ ! 

34701 REM ! FIND COLORS FOR BOTTOM ! 

34702 REM ! FROM & TO (WEST) ! 

34705 REM ! -----------2--222"2+2-°--°--- ! 

34710 BF = 0:8T = 0O 

534720 FOR II =» 8 TO 1 STEP - 1 

34730 IF BLCXX - 1,11,3) ¢ > O THEN BT = 
BLCXZ - 1,11%,3): GOTO 34750 

34740 NEXT II 

$4730 FOR II =» 8 TO 1 STEP - 1 

534760 IF BLCXX,I11,3) ¢ > © THEN BF = BL(X 
ZX,11%,3): GOTO 34780 

34770 NEXT II 

$4780 RETURN 

533000 REM !--------"-"%%-+--- ! 

S5001 REM ! PICK UP ! 

33002 REM !--------------- ! 

$3003 COLOR= WHITE 

533004 HLIN (XX - 130) ® 39 # 1,¢KX - 179 * 3 
3 AT 29 

335005 VLIN (YY - 1) *® 3 + 1,¢¥¥ = 1) * 3 + 
3 AT 29 

53010 IF HD < > O THEN PRINT "VACUUM ERR 
OR": STOP 

33020 GOSUB 33500: REM TB AND PT 

5353030 IF TB = 0 THEN CM8 = "E": GOTO 35095 

593040 IF PT = 3 THEN 35080 

$3030 GOSUB 35600: REM MOVE BLOCK UP 

533060 PT = PT + 1 

533070 GOTO 335040 

$3080 HD = BL(ZX,YY,3>) 

$3090 IF HD = 12 THEN CMt6 = "GREEN" 

55091 IF HD =» 2 THEN CM$ = “BLUE" 

535092 IF HD = 1 THEN CM$8 = "RED" 

53095 IF HD < > 0 THEN RETURN 

$5096 COLOR= BLACK: HLIN (2X - 1) * 3 + 1, 
(XX - 1) *® 39 + 3 AT 29 

33097 VLIN (YY = 1) * 3 + 1,¢Y¥ =- 10 * 3 + 
3 AT 29 

$5100 RETURN 

53500 REM (----------------- ! 

5333501 REM ! FIND TB & PT ! 

53302 REM ! TOP BLOCK COLOR $$! 

5353503 REM ! POS. TOP BLOCK ! 

53305 REM !----------------- ! 

553510 TB = O 

533320 FOR PT = 3 TO 1 STEP - 1 

$3530 IF BLCOXX,YY,PT) < > O THEN 55560 

533540 NEXT PT 

$5550 RETURN 

393560 TB = BL(CXX,YY,PT) 

353370 RETURN 

33600 REM !----------2--------- ! 

535601 REM ! MOVE BLOCK UP ONCE |! 

33605 REM !-------22-"--2e%e¢e¢°%°"°-°- ! 

$3610 BLCXZX,YY,PT + 1)> w=» BLOXZ, YY, PT) 

53620 BL(XX,YY,PT) = O 

535630 GOSUB 3535700: REM RF & RT 

33640 GOSUB 33800: REM BF & BT 

33650 FOR II =» 2 TO 0 STEP - 1 

53660 COLOR= RT 
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35670 


$3680 
53682 


53684 
35686 


55688 
53690 


353692 
35694 
53700 
535701 
95705 
33710 
53720 
353730 


$3740 
33750 
353760 


$3770 
533780 
355800 


53801 
$5805 


53810 
55820 
533830 


533840 
95850 
53860 


33870 
535880 
396000 
36001 
536002 
976010 


536020 
56030 
56040 
56050 
36060 
96070 
536080 
536090 
36095 
76096 


536097 


56100 
36500 
56501 
536505 
5963520 
536530 
536340 
$6550 


A Simulated X-Y Arm 


VLIN C(CYY¥Y = 1) ® 3 + 1)9,¢YY = 1) 8 3 
+ 3 AT 36 = (PT *® 3) + II 

COLORs BT 

HLIN ¢X¥X - 1) *®* 3 + 1,¢¢3X |=} 1) 8 3) 
+ 3 AT 36 —- ¢PT ® 3) + ITI 

COLOR= RF 

VLIN (CYY - 1) 8 3 + 1)9,¢Y¥¥Y =- 1) 8% 3 
+ 3 AT 39 = (PT * 3) + II 

COLORs BF 

HLIN ¢«XX - 1) ® 3 # 1,¢¢8X —- 1) 8 3) 
+ 3 AT 39 — ¢€PT ® 3) + II 

NEXT II 

RETURN 

REM ! j~---—---=------------+ q 

REM ! FIND RF & RT (UP) ! 

REM ! ------------------- ! 

RF = 0O:RT = QO 

FOR II s 8 TO 1 STEP - 1 


IF BLCII,YY,PT) <¢ > O THEN RF = BL‘¢ 


Il,¥Y,PT): GOTO 35750 


NEXT II 
FOR II = 86 TO 1 STEP - 1 
IF BLCII,YY,PT + 1) ¢ > O THEN RT = 


BLC(CII,YY,PT + 139: GOTO 33780 


NEXT II 
RETURN 
REM ! ----+----------------- ! 


REM ! FIND BF & BT (UP) ! 
REM |) s22522 4222 ee ee 1 


BF = 0:BT = 9O 
FOR II 2x 8 TO 1 STEP - 1 
IF BLCXX,I11,PT) ¢ > O THEN BF = BL(¢ 


XX,11,PT): GOTO 35850 


NEXT II 
FOR II = 8 TO 1 STEP - 1 
IF BLCXX,I1I,PT + 1) ¢ > O THEN BT = 


BLCXX,I11,PT + 1): GOTO 35880 


NEXT II 
RETURN 
REM ! ------------=+ ! 
REM ! RELEASE ! 


IF HD = 0 THEN PRINT “VACUUM ERROR 
STOP 
GOSUB 536500: REM FIND PT 

PO = 3: REM POSITION OF BLOCK 


IF PT = PO - 1 THEN 536080 

GCGOSUB 346600: REM MOVE BLOCK DOWN 
PO = PO - 1 

GOTO 36040 
HD = O 


CM$ = "“E" 

COLOR= BLACK 

HLIN (XX = 1) ® 3 # 1,¢XX¥ —- 1) ® 39 + 
AT 29 

VLIN (YY - 1) *® 39 + 1,¢¥¥Y = 1) ® 3 + 
AT 29 

RETURN 

REM !--------------------- ! 

REM ! FIND POS. TOP BLOCK $$! 

REM !--------------------- ! 

FOR PT = 2 TO 1 STEP - 1 

IF BLC(XX,YY,PT) < > O THEN 536550 
NEXT PT 

RETURN 
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36600 
$6601 
546603 
36610 
536620 
536630 
36640 
536650 
536660 
536670 


56680 
536682 


536684 
36686 


56688 
536690 


56692 
56694 
546700 
546701 
56705 
54710 
96720 
36730 


36740 
536750 
36760 


536770 
536780 
56800 
56801 
36805 
536810 
36820 
56830 


536840 
536850 
96860 


56870 
56880 
37000 
37002 
57004 
537010 
537020 
$7030 
537040 
370350 
57070 
37080 
537090 
537100 
537110 
37120 
$7130 
537140 


BLC( XZ 
BL(XX 
GOsSU 


[ase enaedaaeeeeccsese ee ' 
! MOVE BLOCK DOWN ONCE ! 
[sioner nc aanae a eee { 
,¥Y¥,PO - 1) = BL(XX,YY,PO) 
.¥Y¥,PO) = 0 

B 56700 


GOSUB 36800 


FOR II =» 0 TO 2 
COLOR= RT 
VLIN (CY¥YY¥Y =- 1) ® 3 + 1)9,¢¥Y¥¥Y —- 1) 8 93 
+ 3 AT 42 —- ¢€PO ® 3) + II 
COLOR= BT 
HLIN (XX - 1) ® 3 # 1,¢¢€¢8X¥ —- 1) *® 3) 
+ 3 AT 42 + €PO ® 3) + II 
COLOR=s RF 
VLIN (¢YY - 1) ® 3 # 1)9,¢Y¥Y - 1) 8 3 
+ 3 AT 39 —- ¢€PO *® 3) + II 
COLOR=s BF 
HLIN ¢X¥X - 1) ® 3 # 1,¢¢XX¥ —- 1) 8® 3) 
+ 3 AT 39 =- €PO ® 3) + II 
NEXT II 
RETURN 
REM !------------------- ! 
REM ! FIND RF & RT CDN) ! 
REM teeoes cena ee eee 
RF xs» 0O:RT 2 O 
FOR II s 8 TO 1 STEP - 1 
IF BLUCII,YY,PO) ¢ > O THEN RF «= BL¢ 
II,YY,PO): GOTO 3675350 
NEXT ITI 
FOR II 2 8 TO 1 STEP - 1 
IF BL(CII,YY,PO - 1) <¢ >» O THEN RT = 
BLCII.,.YY,PO - 1): GOTO $3780 
NEXT II 
RETURN 
REM !------------------- ! 
REM ! FIND BF & BT (DN) ! 
REM !}—---—------—---------=- | 
BF = 0:BT = 0O 
FOR II =» 8 TO 1 STEP - 1 
IF BL(XX,1I1,P0O) ¢ > O THEN BF «= BL‘ 
XxX,11,P0): GOTO 36830 
NEXT II 
FOR II » 86 TO 1 STEP - 1 
IF BLCXX,I11,PO - 1) ¢ > OO THEN BT = 
BL(CXX,I11,PO -—- 1): GOTO 35880 
NEXT II 
RETURN 
REM !---------------- ! 
REM ! INITIALIZATION ! 
REM !---------------- ! 
DIM BL¢(8,8,3)> 
WHITE = 15 
BLACK = 0 
GEEN = 12 
RED = 1 
BUE 2» 2 
GR 


COLOR= WHITE 


HLIN 
HLIN 
HLIN 
HLIN 
HLIN 


0,25 AT O 

28,39 AT O 
0,25 AT 25 
28,39 AT 253 
0,25 AT 39 
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971350 
37160 
397170 
537180 
37190 
$7200 
372053 
37210 
37220 
37230 
37240 
37250 
37260 
537270 
37280 
$7290 
37300 
37310 
37320 
$7330 
397370 
37375 
37380 
37390 
537400 
37420 
37430 
37440 
37450 
37460 
37470 
37480 
37490 
374953 
$7500 


VLIN 
VLIN 
VLIN 
VLIN 
VLIN 
HOME 
REM 
FOR 


0,2 
28, 
0,2 
26, 
0,2 


5S AT O 
39 AT O 
3S AT 25 
39 AT 25 
S$ AT 39 


DRAW THE ORIGINAL BLOCKS 


II ss 


1 TO 3 


COLOR= BUE 
HLIN 10,12 AT 12 + II 


HLIN 36,38 AT 12 


| > § 


+ 


HLIN 10,12 AT 35 + II 
COLOR= RED 

HLIN 22,24 AT II 

HLIN 36,38 AT II 

HLIN 22,24 AT 35 + II 


COLOR= 


HLIN 
HLIN 
HLIN 
NEXT 
REM 
BL(4, 
BL(6, 
BL(6, 


36, 
16, 
16, 
II 
SET 
5,1) 
1,1) 
7,1) 


GEEN 


38 AT 18 If 
18 AT 35 II 
186 AT 18 + II 


+ + 


UP ORIGINAL COORDINATES 


=» BUE 
= RED 
=z GEEN 


COLOR= WHITE 


FOR 


II «» 


1 TO 3 


HLIN 1,3 AT II 


NEXT 
FOR 


II 
II ss 


1 TO 2 


HLIN 1,3 AT II + 26 
VLIN 1,3 AT II + 26 


NEXT 
xX s= 


II 
1:YyY 


RETURN 


ws 1 


Figure 2.2 (cont.) 
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DEFINING THE GOAL 


The objective for this experiment will be to replace the manual-control pro- 
gram discussed in Chapter 2 with one that is far more intelligent. There will 
still be human inputs, but they will be of a much higher level. The new pro- 
gram will interpret your commands and decide what actions are needed to 
carry out your wish. The high-level commands you will be able to use are listed 


below. 

Command syntax Example 
color,TO,X-Y position BLUE,TO,23 
color,ON,color RED,ON,GREEN 
color, UNDER, color GREEN,UNDER,BLUE 


The format of each command is always three items separated by commas. The 
first command provides a means to move any block to any grid square. If 
another block is already there, the new block will be deposited on the old 
block. Since there are only three blocks and the work area is three spaces deep, 
we do not have to deal with the possibility that there might not be enough 
room at that position for another block. 

The second command allows us to move any block ON any other block. 
If there are any blocks already on either of the blocks in question, they will be 
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moved to empty squares. The last command 1s similar to the second except 
that it moves a block UNDER another block without effecting its original X-Y 
position. 

Imagine for a moment that I asked you to place the red block on the blue 
block using the simulator. How would you decide what keys to press? Could 
you come up with a general set of instructions that someone could use to per- 
form the action? Remember, these instructions must work no matter what 
situation the red and blue blocks are presently in. 

Our objective is to write a program that will do just that. It will accept 
commands in the three forms just given. It should decode the command and 
pass control to one of three modules. Each of these modules, of course, must 
be able to perform the desired operation. Figure 3.1 shows a flowchart for the 
organization of such a program. Refer to this flowchart as you read the 
following discussion. 


USING THE FLOWCHART 


According to the chart, the program will first perform any required initializa- 
tion. This would include things like dimensioning arrays and setting up for 
graphics. The exact requirements will be dealt with later. 

The program then inputs the user’s command. As we just discussed, this 
manual request is made up of three items. The first of these items should bea 
block color. The second is the command and last is the destination. These 
three pieces of information will be stored in the variables B$, A$, and D$ 
respectively. 

The program only needs to examine A§ to decide what type of action is 
being requested. Depending on whether A$ is TO, ON, or UNDER, the 
proper subroutine is called. After the operation is complete, the program 
loops back to input another command. 

This flowchart should appear very simple to you. There are three types of 
commands we can ask the program to handle, so there are three subroutines 
that carry out each of the actions required. It is easy to call the appropriate 
routine. Of course, we must create these three subroutines before the program 
will be complete. 


DESIGNING BY DEFINING 


The first step toward creating or designing any program module is to define 
what we want it to do. The first module for example, handles the TO com- 
mand. It must find the block whose color is in B$ and move it to the position 
designated by D$. D$ may be a number or a color. If it is a number, then it 
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BLOCKS WORLD 


INITIALIZE 
INPUT 
BS, AS, DS 


MOVE COLOR 
IN BS TO 
POSITION 

IN DS 


MOVE COLOR 
IN BS ON 
COLOR IN 

DS 


AS = “UNDER” 


MOVE COLOR 
IN BS UNDER 
COLOR IN 
DS 


Figure 3.1 This main flowchart for the BLOCKS WORLD program establishes the 
need for three major modules. 


should be interpreted as a coordinate. If itis a color, then the module will need 
to find the coordinates of the block of that color. 

In a similar fashion, we can define the requirements of the other two 
modules as moving the color in B$ either ON or UNDER the color in D§. I will 
be using this technique to design all of the programs in this book. It is very im- 
portant that you understand this method of designing by defining. Let’s ex- 
amine it in detail. 

The original flowchart in Figure 3.1 is very simple because, as soon as I 
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got to something complicated, I drew a box with two lines on its sides and 
assumed it was a subroutine that could solve the problem. I have defined each 
of these boxes briefly, but before these subroutines can be written, we need to 
formalize their requirements. This formalization means that every subroutine 
should have a flowchart of its own to define its operation. 

As we define a subroutine we will be consistent and continue to follow 
my original rule of simplicity. Every time the flowchart starts to get com- 
plicated we must make up a new subroutine to solve the problem. At the time 
that a subroutine is conceived, we only need to decide what it must do. We do 
not need to know how it will accomplish its task. 

After the flowchart we are working on is complete, we will form addi- 
tional flowcharts for each of the new subroutines we used. As we create those 
flowcharts, we will again define new subroutines in the same manner. This 
top-down design continues until the routines needed to accomplish a task are 
of a trivial nature. 


LOGICAL CONTROL STRUCTURES 


A program created in this manner is a pyramid of subroutine calls (GOSUB 
commands). At the bottom of the pyramid are the primary tasks that perform 
the actual work of the program. The intelligence of the program arises from 
the orderly combination of these tasks. The flow of the program will be 
regulated by control structures, or constructs for short. 

The primary construct is the IF-THEN-ELSE. Using it, you can create 
more sophisticated constructs such as FOR-NEXT or REPEAT-UNTIL 
loops. Unfortunately many BASIC interpreters have only a small variety of 
constructs available to the programmer. As we shall see, though, we can 
create any additional constructs needed using IF statements. 

Now that you understand the philosophy to be used, let’s continue and 
see how easy it can be to program using these methods. Referring back to 
Figure 3.1 we can see the three subroutines that we need. The numbers by each 
block correspond to the BASIC line where the subroutine will eventually 
reside. These numbers do not have to be in any particular order. I assigned 
them on a first come, first serve basis. The COLOR TO POSITION module 
for example, will be coded at line 100. 


FLOWCHARTING THE MODULES 


Figure 3.2 shows the expansion of the COLOR TO POSITION module. In 
order to Keep the flowchart simple, I again created two new modules. At 400 is 
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100 


COLOR TO 
POSITION 


200 


COLOR ON 
COLOR 


CLEAR ANY 
BLOCKS FROM 
COLOR IN D$ 


400 


PICKUP C$ 


500 


MOVE COLOR 


PLACE AT IN BS TO 
DESTINATION DESTINATION 
D$ D$ 


Figure 3.2, The COLOR TO POSITION module re- Figure 3.3 The COLOR ON COLOR module is made 
quires two new modules. up of one new module and one that was pteviously 
defined. 


a very general purpose module. It will pick up the block specified by the 
variable C$, which in this case has been set equal to B$. The second module is 
at 500. It will drop whatever block is presently in the hand at the position 
specified by D$. 

It should be obvious how these two modules solve the problem of 
COLOR TO POSITION. Remember, the function of this module is to move 
the block in B$ to the destination specified by D$. To perform this activity, we 
need to do two things. First, pick up the block and then place it at the destina- 
tion. We have solved the problem by defining what has to be done. Naturally, 
we still need to define the two new modules, and we will in just a moment. 
Let’s continue a little further though, and see how the COLOR ON COLOR 
and COLOR UNDER COLOR modules can be expanded to their second 
level. 

Figure 3.3 shows the COLOR ON COLOR expansion. The first require- 
ment is to clear any blocks that are on top of the destination block. Since this 
is a relatively complicated problem, I again make up a module to perform the 
action. All that is left to do is to call our original module, COLOR TO POSI- 
TION, which will move the block in B§$ to the now cleared destination block. 

The COLOR UNDER COLOR module is a little more difficult. If you 
have followed everything so far, I don’t think you will have any trouble. If 
you are the least bit confused, then back up and review the previous 
flowcharts. 
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300 


COLOR UNDER 
COLOR 


MOVE D$ TO 
TEMPERATURE 
SAVING ORIGINAL 


POSITION IN T$ 


EXCHANGE 
D$ AND T$ 


100 


MOVE (BOTTOM) 
BLOCK TO 
DESTINATION 


MOVE (TOP) 
BLOCK TO 
DESTINATION 


RETURN 


The expansion of COLOR UNDER COLOR is shown in Figure 3.4. If 
we are going to move one block under another, we must temporarily store the 
second block. I created a module at 700 to perform this task. It not only moves 
the block specified by D§ to a temporary position, but it also stores the coor- 
dinates of the original position in the variable T$. 

The next step is to exchange the contents of the variables D$ and T$. A 
call to COLOR TO POSITION will now move the first block to the original 
position of the second block. If we copy the color of the original block (now in 
T$) into B$ we can again call BLOCK TO POSITION to complete the 
COLOR UNDER COLOR module. 


Figure 3.4 A previously defined module 
(100) is used twice in the COLOR UN- 
DER COLOR expansion. 


REVIEW NOW IF NECESSARY 


It is very important that you do not continue any further till these first flow- 
charts are completely clear to you. If you are having trouble understanding 
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them, let me offer some advice. Run the manual version of the simulator. Us- 
ing a variety of commands, trace through each of the flowcharts. At each step, 
perform the operations indicated by the boxes. As you move from subroutine 
to subroutine, you will find that the logic will slowly but surely become more 
understandable. If you feel such activity is a little juvenile, postpone your 
prejudice until you have tried it at least once. 

At this point, you should have a good idea of the major activities re- 
quired by the program to manipulate our blocks world. Our next step is to 
move down another layer in the subroutine pyramid to see how the latest 
modules can be further defined. Let’s start by breaking down the modules in 
COLOR TO POSITION. 

The PICK UP C$ is a little more complicated than you might first 
suspect. The reason for this 1s that there may be blocks on top of the block we 
wish to pick up. Let’s examine Figure 3.5 to see how I solved the problem. 
First, the hand is moved over the block in C$. Next, a block is picked up. This 


400 


PICK UP C$ 


MOVE HAND 
OVER C$ 


PICK UP TOP 
BLOCK SAVE 
COLOR IN H$ 


IF 

COLOR 

MATCHES 
C$ 


RETURN 


MOVE TO 
EMPTY SQUARE 


RELEASE 
BLOCK 


Figure 3.5 The module that picks up a 
specified block will automatically discard 
any blocks that were on the desired block. 
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block may or may not be the one desired. If it is the correct block, then the 
operation is complete. If it is some other block, then it is moved over an empty 
square and released. This procedure is repeated until the right block is found. 

Seems pretty simple, doesn’t it? The actions performed are all fairly ob- 
vious. Don’t forget, though, why it is so simple. Each of the required actions 
for this module are very complicated, but I just created the three I needed to 
get the job done. I did not allow any worry of how these created modules 
would perform their jobs to cloud my understanding of the routine being 
designed. I just defined the functions needed. I will explore each of these 
newly defined functions in detail in the next lower level of the pyramid. At 
that point, they will be easy to define fully because I can consider them one at 
a time. 

Figure 3.6 shows how PLACE AT D$ is expanded. Once the destination 
is copied into C$ we can use the MOVE HAND OVER C$ routine already 
created. A new routine is used to actually release the block. 

Figure 3.7 shows how to CLEAR BLOCKS FROM D&S. The destination 
block is picked up using PICK UP C$. This module, as you recall, moves all 
the blocks found first to empty squares. By calling RELEASE BLOCK, the 
block is returned to its original position with no blocks on top of it. 


500 600 


PLACE AT CLEAR BLOCKS 
D$ FROM D$ 


1100 


MOVE HAND 
OVER C$ 
RELEASE 
BLOCK 


1400 
RETURN 


RELEASE 
BLOCK 
Figure 3.6 This flowchart shows how the block in the Figure 3.7 The previously define PICKUP module 


RETURN 
hand is deposited at the correct destination. does most of the work for this CLEAR routine. 


400 


PICK UP 
C$ 


1400 
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MULTIPURPOSE MODULES 


One of the nice things about modular programming is that some modules can 
often be used by several other modules. This is especially true when the 
modules are general-purpose. All of my modules that utilize C$ demonstrate 
this ability. If you have not been aware of this action, then study the previous 
flowcharts again. Once you feel secure, proceed to examine the few remaining 
flowcharts for the blocks world manipulation. 

One of the created modules for COLOR UNDER COLOR was MOVE 
D$ TO TEMP. It is expanded in Figure 3.8. Once D$ is copied into C$, the 
PICKUP module gets the desired block. The coordinates are saved in T$. Two 
other modules place the block in an empty square until it is needed. 

A LOCATE C$ module is used to find the X-Y coordinates of the color 
found in C$. Figure 3.9 shows how it is done. Depending on the color, the ap- 
propriate values are copied into X and Y. The present position of the green 


700 


MOVE D$ TO 
TEMPERATURE 


400 


PICK UP 
C$ 
SAVE X-Y 
IN TS 


1200 


MOVE TO 
EMPTY SQUARE 


1400 
RELEASE 
BLOCK | 


RETURN 


Figure 3.8 The use of previously defined 
subroutines makes the implementation of 
this module very simple. 
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900 


LOCATE C$ 


THEN 
COVERT TO 
X-Y 
RETURN 
X = GX 
Y=GY 
IF THEN 
C$ IS 
RETURN RED 
X = RX 
Y =RY 


THEN C$ IS 


BLUE RETURN 
X = BX 
Y = BY 


RETURN 


Figure 3.9 The method for establishing 
RETURN the coordinates of the desired block is 
shown in this flowchart. 


block is kept in the variables GX and GY. Likewise, the red block can be 
found at RX and RY while the blue block is at BX and BY. 

The MOVE TO C$ module in Figure 3.10 uses the LOCATE C$ to estab- 
lish X and Y before calling the MOVE TO X-Y module. The MOVE TO 
EMPTY POSITION module is very similar except that it LOCATES AN 
EMPTY POSITION in the X-Y coordinates. This module is shown in Figure 
3.11. The expansion of the MOVE TO X-Y module can be seen in Figure 3.12. 

Figure 3.13 shows how to FIND an EMPTY SQUARE. A DATA state- 
ment holds the coordinates of four possible choices for an empty position. 
Four choices are enough because there are only three blocks. The four possi- 
bilities I used were the four center squares in the blocks world. This should 
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1100 1200 


LOCATE C$ 
AS X-Y 


MOVE TO 
EMPTY POSITION 


1300 


LOCATE EMPTY 
AS X-Y 


1000 


MOVE TO 
X-Y 


MOVE TO 
X-Y 


RETURN RETURN 
Figure 3.10 Moving to the desired block is done by Figure 3.11 This module differs from Figure 3.10 only 
locating the position and moving to it. in that the first module finds the coordinates of an 


empty square. 


keep the hand’s average travel time to a minimum. Each time an empty square 
is needed, the DATA statement is read until one is found. 

The RELEASE BLOCK module has to do more than just drop the block 
being held, as you can see from Figure 3.14. Every time a block is released, the 
coordinates for that block must be updated so that other modules will always 
know where each block is. 


CODING THE PROGRAM 


This completes the discussion on the flowcharts. You should now have a com- 
plete understanding of the logic used to manipulate the blocks world. Don’t 
hesitate to use the manual simulation to aid your understanding of the system. 
The next step is to convert the flowcharts into code. This coding process 1s 
what most people refer to as programming. They also assume it is very time- 
consuming. Fortunately, they are wrong in both cases. 

Programming is made up of planning, organizing, structuring, testing, 
and to a small extent, coding. If the programmer does a thorough job during 
the early stages, then the coding is almost trivial. Let’s compare the program 
in Figure 3.15 to the flowcharts just discussed. 

Figure 3.1 showed the overall organization of the program. The initial- 
ization begins at line 50 of the code, which sends the command / to the 
videobot subroutine. Line 55 establishes the beginning coordinates of the 
three blocks so that they begin where the videobots’s initialization put them. 
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MOVE TO 
X-Y 


WHILE PRESENT 
POSITION IS 


NOT X-Y 


RETURN 


MOVE 
EAST 


4 


1300 
FIND EMPTY 
SQUARE 


PREPARE TO 
READ DATA 
STATEMENT 


MOVE 
WEST 


4 


READ A SET OF 
COORDINATES 
(EX, EY) 


IF 


MOVE BLUE IS 


SOUTH 


4 


MOVE 
NORTH 


ne 


END WHILE RETURN 
Figure 3.12 Moving to a specific location is accomplished Figure 3.13 Finding an available square in- 
with a loop that makes many small moves until the destina- volves examining the contents of the four 
tion is reached. centrally located positions, until an empty one 


is found. 
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1400 


RELEASE 
BLOCK 


DROP BLOCK 


RETURN 


Figure 3.14 The RELEASE BLOCK 
module will update the variable that keeps 
track of the positions of each block. 


The desired command sequence is input at line 60. Depending on the 
command asked for, one of three IF-THEN statements transfers control to 
one of the three major modules. This is so easy it would be a little wasteful to 
continue this throughout the whole program, but lets look at one more 
module. 

At line 100 for example is the coding for Figure 3.2. Notice how straight- 
forward it is. As I stated earlier, a well-organized program usually is made up 
mostly of subroutine calls. This program, obviously, is no exception. Take a 
few moments to compare each of the flowcharts with the program. You 
should be able to make a one-to-one correspondence easily. I hope at this time 
you are agreeing with me that coding is trivial. 
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BLOCKS WORLD 


REM /! ---------------------------- ! 
REM ! BLOCKS WORLD SIMULATION ! 
REM ! COPYRIGHT BY § 
REM ! JOHN BLANKENSHIP ! 
REM ! JUNE 1983 ! 
REM ! ~-- 2-2-2 ee ee ee ee ee ee ! 
CMS =» "I": GOSUB $0000: REM INITIALIZE 
BX =» 4:BY = 3:GX = 6:GY = 7:RX¥ =» 8:RY = 1: REM ES 
TABLISH STARTING POSITIONS 
INPUT "SOURCE ,COMMAND,DEST. ";,;BS,A$,D$ 
IF ASQ s “TO” THEN GOSUB 100: GOTO 60 
IF AG® =z» "ON" THEN GOSUB 200: GOTO 60 
IF AS ws "UNDER" THEN GOSUB 300: GOTO 60 
GOTO 60 
REM ! ---------------- ! 
REM ! MOVE COLOR IN ! 
REM ! BS TO POSITION |! 
REM |! IN Ds { 
REM ! ---------------- ! 
ce = BS 
GOSUB 400: REM PICK UP C& 
GOSUB 300: REM PLACE IN DESTINATION 
RETURN 
REM ! ---------------- ! 
“REM ! MOVE COLOR IN i] 
REM ! BS ON COLOR ! 
REM ! IN D8 ' 
REM / ----+------------ § 
GOSUB 600: REM CLEAR THE ON BLOCK 
GOSUB 100: REM MOVE BLOCK TO DEST. 
RETURN 
REM ! ---------------- ! 
REM ! MOVE COLOR IN ! 
REM ! BS UNDER COLOR $$! 
REM ! IN D$ ! 
REM ! -------------+--- 4 
GOSUB 700: REM CLEAR UNDER POSITION 
ES = T#:T$ 2» DS: DS 2 ESC: REM EXCHANGE D$ & TS 
GOSUB 100: REM MOVE BOTTOM BLOCK 
BS ws T$ 
GOSUB 100: REM MOVE TOP BLOCK 
RETURN 
REM ! ------------------ ! 
REM ! PICK UP BLOCK C8 ! 
REM ! PUTTING ANY ! 
REM ! EXTRA BLOCKS IN ! 
REM ! EMPTY POSITIONS §$! 
REM !--------------+-+--- ! 
GOSUB 1100: REM MOVE OVER C$ 
CM6$ =» "P": GOSUB 30000: REM PICK UP 
HS w#» CMS: REM SAVE COLOR 
IF CM$S8 =» C%& THEN RETURN 


GOSUB 1200: 


REM MOVE TO EMPTY SQUARE 


GOSUB 1400: REM RELEASE BLOCK 
GOTO 410: REM KEEP LOOKING 
REM | ------------------- { 

REM ! PUT BLOCK IN HAND ! 

REM ! AT DESTINATION ! 

REM !-------2-"-"-%°""%°°-- ! 


Figure 3.15 BLOCKS WORLD 


Coding the Program 29 


5310 Cé = D$ 


3520 
540 
5350 
600 
601 
602 
610 
630 
660 
670 
700 
701 
702 
710 
720 
725 


730 
740 
7350 
760 
780 
900 
901 
902 
903 
910 


920 
930 
940 
1000 
1001 
1002 
1010 


1020 
1030 
1040 
1050 
1060 
1070 
1100 
1101 
1102 
1110 
1120 
1130 
1200 
1Z01 
1202 
1205 
1210 
1220 
1230 
1300 
1301 
1302 
1303 
1310 
1320 


GOSUB 1100: REM MOVE OVER C$ 

GOSUB 1400: REM RELEASE BLOCK & UPDATE 
RETURN 

REM |e 65 see ee ! 

REM ! CLEAR ON BLOCK ! 

REM 1 <<e<6 sede eecacnas ‘ 


C$ = D$: REM LOCATE USES C$ 


GOSUB 400: REM PICK UP C$ 
GOSUB 1400: REM RELEASE IT 
RETURN 

REM ! ------------------ ! 
REM ! CLEAR UNDER POS. $$! 
REM ! ------------------ ! 


C$ a DS 


GOSUB 400: REM PICK UP C$ 


TS = STRS$ ¢€10 "% X + ¥): REM SAVE POSITION BEFO 


RE CLEARING SPACE . 

GOSUB 1000: REM MOVE TO IT 

GOSUB 1100: REM PICK IT UP 

GOSUB 1200: REM MOVE TO THE STORAGE POSITION 
GOSUB 1400: REM RELEASE BLOCK 


RETURN 
REM. §=22e-4ssee eee eee ce { 
REM ! PLACE CO-ORDINATES ! 
REM ! OF C$ INTO X AND Y ! 
REM (eseew denen ee ae ' 


IF VAL (C$) <¢ > O THEN X = VAL (€ LEFTS (C$,1) 
>:¥Y «= VAL ( RIGHTS (C&,1)9): RETURN 

IF C$ =» "GREEN" THEN X =» GX:Y = GY: RETURN 

IF Cte = "RED" THEN X¥ = RX:Y¥Y = RY: RETURN 

IF C$ =» "BLUE" THEN X = BX:Y =» BY: RETURN 


IF (xx <¢ > X¥) OR ¢CYY <¢ > YD THEN GOSUB 1030: 
GOTO 1010 


RETURN 

IF XX « XK THEN CM$ = “E": GOSUB 350000 
IF XX >» X THEN CMS = "W": GOSUB 350000 
IF YY < ¥Y THEN CM$6 = "SS": GOSUB 30000 
IF YY >» ¥ THEN CM$8$ ss "N": GOSUB 30000 
RETURN 

REM ! -------------------- : 

REM ! MOVE HAND OVER C8 ! 

REM ! --------9-2""ee%e%%%°%°-->- ! 


GOSUB 900: REM LOCATE C$ 

GOSUB 1000: REM MOVE TO IT 
RETURN 

REM ! ---------- 9-9-2 2ee%e"-"--- ! 

REM ! MOVE TO EMPTY SQUARE |! 

REM ! ------------22-5-""°--- ! 
GOSUB 1300: REM FIND EMPTY SPACE 
X 2 EX:Y¥Y w=» EY: REM SET UP CO-ORD. 
GOSUB 1000: REM MOVE TO X-Y 


RETURN 
REM. (s2seeoeeseoeeee ee ' 
REM ! FIND COORD. OF ! 
REM ! AN EMPTY SQUARE ! 
REM be<-eceesee sence cs { 
RESTORE : REM PREPARE TO READ DATA STATEMENTS 


READ EX,EY: REM GET NEXT POSSIBLE COORD. 


Figure 3.15 (cont. ) 
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1330 IF (EX = BX) AND CEY = BY) THEN 1320 
1340 IF ¢€EX =» RX) AND CEY = RY) THEN 1320 
1350 IF (EX =» GX) AND ‘EY = GY) THEN 1320 


! RELEASE THE BLOCK ! 
1402 REM ! NOW IN THE HAND ! 
! AND UPDATE COORD ! 
t OF THE BLOCK MOVED !! 


=z "GREEN" THEN GX = X:GY = Y¥: GOTO 1440 
=z "RED" THEN RX = X:RY = ¥: GOTO 1440 

1430 IF H$ = "BLUE" THEN BX =» X:BY = ¥: GOTO 1440 
R GOSUB 530000: REM RELEASE IT 


Ssoool REM ! VIDEOBOT ! 
530002 REM ! A VIDEO ROBOT ! 
50003 REM ! COPYRIGHT 6/62z ! 
30004 REM ! BY ! 
50005 REM ! JOHN BLANKENSHIP ! 


Figure 3.15 (cont. ) 


TRY IT OUT 


Now that you understand how this program is supposed to operate let’s try it 
out. If you have the disk, RUN BLOCKS WORLD. Otherwise, LOAD the 
videobot you have previously typed in, delete lines 1 through 200, and then 
enter the code in Figure 3.15. Run the program, and enter some commands 
such as those below. 


RED,ON,GREEN 
BLUE,UNDER,GREEN 
BLUE,TO,76 


I think you will find this program very intriguing. Even a simple com- 
mand causes a relatively large amount of action on the screen. The program 
shows a reasonable amount of artificial intelligence. The intelligence is artifi- 
cial because the system cannot adapt to unexpected situations. It can only 
react exactly as it was programmed and only to the stimuli that was defined 
initially. The videobot, however, will handle some problems that we did not 
specifically consider. 

As we learn more about how the human mind functions, perhaps we can 
create machines with similar abilities. Machines that alter their criteria for 
making decisions based on their environment will be truly, not artificially, in- 
telligent. Perhaps we would be better off to describe the ‘‘thinking’’ process 
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of our computers as machine intelligence. At least it would alleviate some 
heated arguments about whether machines reason or not. 

Now that we can use a computer program to control a video simulation, 
we are a little closer to one of our major objectives—to control a real arm. In 
the next chapter, I will show you how to do just that. And we will doit with the 
exact same program that we have been studying. If you have any doubt about 
your understanding so far, then review before proceeding. 


SUGGESTIONS FOR FURTHER STUDY 


The blocks world manipulated by my program can contain no more than three 
blocks. This is true for several reasons. The most important of these are: 


1. There was no check to see if the blocks became stacked above the three- 
deep limit. 

2. There are only four empty squares in the DATA statement. 

3. It is possible for the hand to become jammed if the block being carried 
runs into a stack of three blocks. 


The advanced reader might want to modify the existing BLOCKS 
WORLD program so that it can handle four or five blocks. You will have to 
alter the initialization module (line 57000) in the simulation program to create 
the new blocks originally. Once that is done, the simulator will handle as many 
blocks as you wish to use. 


A Mechsnical 
X-Y Arm 


CONSTRUCTION 


In the last chapter, we saw how to control a video-simulated arm. In this 
chapter, I would like to show you how to apply the just-learned principles toa 
real arm. Our overall goal is to construct a physical arm that can be controlled 
with the software described in Chapter 3. 

The arm must be able to reasonably duplicate the actions found in the 
video simulation. There will be a number of compromises needed to complete 
this arm. As the text progresses and your knowledge increases, more and more 
of these compromises will be dropped. Figure 4.1 shows the mechanical 
Organization of a suitable arm. 

Since the arm requires linear movement in two directions, I chose to use 
two threaded rods to create the action. At the end of each rod is a gear train 
and a small motor. A long nut will move up or down the rod depending on the 
direction of the motor’s rotation. One of the nuts is connected to a metal 
bracket that supports the second rod and nut. 

The opposite end of the support bracket must be connected to some 
form of linear bearing. A brass tube that slides on a smaller brass rod or tube 
will suffice nicely. I used such an arrangement before I found an ideal bearing 
at a local surplus dealer. Because this arm does not have to lift heavy loads, 
the connections to the tubes and nuts can be made with a high-quality glue. I 
found metal-based epoxies to be excellent. 
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Figure 4.1 Two threaded rods are used to move the manipulator throughout the 
X-Y plane. 


The video arm’s hand picked up objects by using a ‘‘vacuum.’’ This 
could be done by using a rubber tube connected to a small automobile vacuum 
cleaner. I, however, found it quieter and more practical to use an electromag- 
net. To make things as versatile as possible, I attached a spring-loaded clip to 
the second nut. This clip can easily be used to hold the magnet or even a pen so 
that the arm can be used as a plotter. I will discuss the hand in more detail later 
in this chapter. 
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As the hand moves, it is important that its position can be determined by 
the computer. The method I used to keep track of the hand’s location was to 
count the number of revolutions of the threaded rods. I carefully drilled two 
holes in one of the plastic gears between the motor and the rod. As the gear 
rotates it breaks a beam of light created by an infrared LED (light emitting 
diode). You will see how easy it is for the computer to count these pulses when 
I discuss the software interface. 

Since the mechanical system operates with very little stress, you should 
be able to build it with materials found at any hardware store. Very little of the 
construction for this arm is critical, but there is one thing that is very impor- 
tant. The gearing between the motor and the threaded rod must cause the 
hand to move at a relatively slow rate. This means you can use a small motor, 
but even more important, the hand will stop moving immediately when the 
motor is turned off. If the speed of the hand is too fast, the hand will coast a 
little after being told to stop by the computer. Later chapters will show how to 
solve this problem, but for now I want to keep things simple. 


USE SURPLUS WHEN POSSIBLE 


When I built the arm, I was very lucky to find a surplus item that made the 
construction easy. This item, a reading pacer, can be seen in Figure 4.2. Its 


Figure 4.2 A surplus reading pacer pro- 
vides an excellent beginning for the X-Y 
arm. 
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Figure 4.3 My completed X-Y arm is 
constructed primarily of surplus items. 


Figure 4.4 Gears are used to reduce the 
motor speed so that the manipulator 
motion is very slow. 


original use was to move a plastic guide down a printed page to force you to 
read faster. Internally, it is a small 3 volt motor, a gear train, and a threaded 
rod. Obviously, it is perfect for use in the X-Y arm. Figures 4.3 and 4.4 show 
the details of the completed arm. 

The physical construction of an arm can be time consuming. Be patient, 
and make sure that everything lines up properly so that friction can be kept to 
a minimum. Once you have the arm built, test it by hooking the motors toa 
battery or a power supply to ensure that nothing is binding. If you have trou- 
ble in this area, just mount the brackets holding the solid rod with a thick layer 
of silicon glue. The elasticity of the glue will allow the bracket to move just 
enough to prevent problems. Once the physical operation is acceptable, you 
can begin to think about the electronic interface for the motors. 
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MOTOR CONTROL 


If the computer is going to control the arm, it must be able to not only turna 
motor off and on, but also to reverse its direction. Figure 4.5 shows how this 
can be done manually. A single throw, single pole switch handles the on/off 
condition of the motor. The reversing requirement is performed by a double 
throw, double pole switch. The DPDT switch causes the motor current to be 
reversed when the switch is changed. 

Our objective will be to replace these switches with transistors. Readers 
who are less familiar with electrons can refer to Figure 4.6 to see the symbols 
used to represent PNP and NPN transistors. 

Figure 4.7 shows a simplified model of how a transistor operates. The 
resistance between the collector and the emitter is dependent on the current 
from base to emitter. As the base current increases, the CE resistance drops 
Causing an increase in the collector current. By changing this resistance be- 
tween zero ohms (saturation) and infinity (cutoff), the transistor can act just 
like a SPST switch. 

This switch action can be used to turn on and off a motor, a relay, or 


ON/OFF 


DIRECTION 


BATTERY 


Figure 4.5 Switches can be used to aid our understanding of the circuitry needed 
to control a DC motor. 


COLLECTOR 
BASE NPN 
EMITTER 
BASE PNP 
COLLECTOR 
Figure 4.6 The schematic symbols differ only Figure 4.7 Transistors can easily simulate the 


slightly for PNP and NPN transistors. action of a mechanical switch. 
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most any type of load. Figure 4.8 shows the circuit configurations for both 
PNP and NPN transistors. The 7404 inverters act as buffers and are optional, 
but recommended. They control the base current and turn the load on or off 
as shown. The diode is used to suppress the voltage transients created by loads 
such as motors and relays, which have magnetic fields. Almost any diode will 
work for this application. Just make sure it has a forward current rating of at 
least 0.5 amps. 

You could use a DPDT relay to reverse the current to a motor. A tran- 
sistor could be used to turn the relay on and off. A second transistor could be 
used to turn the motor on and off. Figure 4.9 shows how this could be ac- 
complished. The disadvantage of this method is the slow response time of the 
relay. 

The basic principle of a faster method for controlling the motor is shown 


0-ON 1-2K 
So 
1-OFF 7404 


Figure 4.8 Switches may be made from either PNP or NPN transistors. 


+V 


ON/OFF 


FORWARD/ 
REVERSE 


Figure 4.9 Two transistors and a relay provide the identical action found in Figure 
4.5. 


38 A Mechanical X-Y Arm 


+V 
A B 
ain, 
aie’ 
C D 


Figure 4.10 An alternative organization 
of switches provides more flexible con- 
= trol of a motor. 


in Figure 4.10. Assume, for the moment, that the switches A through D repre- 
sent transistors. Turning on switches B and C will result ina current flow as in- 
dicated by the arrow. Switches A and D will reverse the current direction 
through the motor, and, thus, the motor rotation. The motor can be stopped 
by turning all the switches off. You can see a full implementation of this prin- 
ciple in Figure 4.11. 

The AND gates in Figure 4.11 serve two functions. First, they act as buf- 
fers to help isolate the computer from the transistors. They also utilize their 


56K 
180022 


56K 
180022 


Figure 4.11 Transistors can completely replace the switches of Figure 4.10. 
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logic to make the implementation of F/R (forward/reverse) and ON/OFF 
easy. The AND gate requires a 1 on both inputs to get a 1 out. Note also thata 
1 is required to turn on the NPN transistors. The ON/OFF line connects to 
every AND gate so that no transistors can ever be on when ON/OFF is low. 
When ON/OFF is high, the F/R line and the inverter make sure that only the 
appropriate transistors will get enabled. 

In this and all of the previous circuits, you can use most any transistors. 
The larger the motor is you wish to control, the greater the collector current 
rating of the transistor should be. Since the transistors are being used as 
switches, the gain is not critical as long as it is large enough. In general, if you 
use darlington transistors, you won’t ever have any problems with too small a 
gain. You should also note that any transistor will overheat when operated 
near its maximum ratings, so don’t hesitate to use heat sinks when necessary. 


NOISE PROBLEMS 


You could build one of the circuits just described, and your computer might 
be able to control the motors in your robot arm. Notice, I said might. Unfor- 
tunately, the real world is filled with electronic noise and power glitches. A 
DC motor, for example, will create all sorts of problems because of the sparks 
created by its brushes. 

This brush noise can be greatly reduced by adding the circuit of Figure 
4.12 to each of the motors that you use. The values of the components are not 
critical. The capacitors I use are 0.lyf, and they should be ceramic disks. The 
coils are easier to make than to buy. Wrap ten to twenty turns of wire on a %« 
inch wooden dowel. This circuit is especially important if your motors draw a 
lot of current. Naturally, this applies to any large motor. Unfortunately, it 
also applies to many small, inexpensive motors often found in children’s toys. 
In many cases, these motors are very inefficient and require much more power 
than you would expect. 

Another effective way of preventing motor noise from entering the com- 
puter system is to use separate power supplies for the motor and the comput- 
er. To do so we must provide nonphysical connections between the computer 


CDSE \ 


Figure 4.12 The brush noise of DC mo- 
tors may be quieted with the proper fil- 


= ters. 
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and the motor-drive circuit. This connection will be made using an optical 
isolator. 


OPTICAL ISOLATION 


Figure 4.13 shows how to use an optical isolator. The isolator itself is made 
from a light emitting diode and a photo transistor. Nearly all isolators come in 
a 6 pin dip package as shown. When the computer sends a | to the inverter, a 0 
will be applied to pin 2 of the isolator. This 0 will turn on the internal LED 
and, in turn, cause the photo transistor to saturate. The photo transistor will 
draw current away from the base of the transistor causing it to turn off. The 
Opposite situation would allow base current, causing the transistor to con- 
duct. 

Since there are absolutely no connections of any kind between the com- 
puter and the motor drive circuit, then brush noise and power surges can not 
cause problems. In addition to aiding in the prevention of noise, an optical 
isolator can help when controlling motors that run on more than 5 volts. 

The circuit of Figure 4.11 1s a good example. If the voltage labeled + V is 
around 5 volts (TTL levels) then everything works fine. If + V is increased to 
12 volts, though, then the 5 volts coming from the AND gates will not be suffi- 
cient to turn on the top two transistors. Controlling these transistors with op- 
tical isolators, as shown in Figure 4.13, will solve the problem by providing 12 
volts to the base through the 56K resistor without conflicting with the TTL 
gates. 

Optical isolators are very handy devices. After using them in a few pro}j- 
ects, you will probably wonder how you got along without them. They cer- 


COMPUTER SUPPLY MOTOR SUPPLY 
+5V +V 
OPTICAL ISOLATOR 


COMPUTER GROUND 


MOTOR GROUND 


Figure 4.13 Optical isolation provides an even greater immunity to noise. 
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tainly are a must when it comes to controlling motors with noise-sensitive 5 
volt logic. 

The ability to turn a motor on and off is only the beginning. The com- 
puter must know when to turn it on and off. More specifically in this case, the 
computer must be able to turn on the motor just long enough to move the arm 
a predetermined distance. We could try turning the motor on for a specified 
period of time. The distance the arm would move, however, would be deter- 
mined not only by the time, but by the load carried by the arm, by the friction 
encountered, and by the power supply voltage. We could, of course, try to 
hold all these items as constant as possible, but our accuracy would be limited. 


OPEN VS. CLOSED-LOOP SYSTEMS 


The type of system just described would be an open-loop control system. It is 
an open loop because if we issue signals to make the arm move, we get no in- 
formation back to verify that the movement actually took place. In a closed 
system, the loop is complete. By that, I mean that feedback is used to deter- 
mine not only that movement occurred, but how far the movement was. Such 
information will allow the computer to easily determine when a desired 
destination is reached, and thus, when to turn a motor Off. 

Throughout the book, I will show you several ways to acquire these feed- 
back signals. In this chapter, I want to concentrate on a method known as in- 
cremental encoding. As you will recall, one of the gears in each drive train had 
holes around its edges that could make and break an infrared beam. If we can 
count the number of pulses created by the interruption of this beam, we can 
determine the number of revolutions of the threaded rod and, indirectly, the 
amount of linear motion. 

One way to perform this counting operation would be to send the pulse 
to a physical counter made up of flip flops. A suitable circuit capable of 
counting 255 pulses is shown in Figure 4.14. If we assume we have some means 
of reading the state of this counter (an input port) and some means of sending 
a signal to clear it (an output port), then the computer can utilize the feedback 
by doing the following. 

When the computer decides to move a given distance, it first converts the 
distance into an equivalent number of pulses. After the counter is cleared, the 
motor is turned on until the counter is equal to or greater than the desired 
number of pulses. The ‘‘greater than’’ portion is a safety factor just in case the 
motor’s inertia causes it to travel slightly farther than the desired point. I 
should also mention that it will be the program’s responsibility to keep track 
of which direction the motor travels. The counter will count up regardless of 
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Figure 4.14 Cascading two 4-bit counters provides a means to count 255 pulses. 


whether the motor is going forward or reverse. If you want to move the motor 
more than 255 pulses you will have to make the move using a series of smaller 
moves. 


ELIMINATING BOUNCE 


In order for the previous ideas to work properly, the counter must increment 
once, and only once, for each pulse it receives. This, unfortunately, is not go- 
ing to happen without a little work. As it turns out, the gear with the holes init 
is subject to vibration from the motor. This vibration, no matter how slight it 
appears to you, can cause erratic breaking of the beam, making the pulses 
have ragged edges. These ragged edges are referred to as bounce and can cause 
the counter to increment several times for each pulse. 

The ragged edges of the pulses can be eliminated easily with electronics. 
Figure 4.15 shows a simple circuit to do just that. Each time the light strikes 
the photo transistor, it conducts causing the input to the inverter to go low. 
The inverter, in turn, causes the second transistor to conduct which triggers 
the 555 timer through the 0.lyf capacitor. 

The 555 timer has been wired to act as a monostable circuit with a 500s 
output pulse. This means that when the 555 timer gets a short pulse on pin 2 it 
generates a S500us pulse on pin 3. The key fact is that if several pulses are ap- 
plied to pin 2 within a 500s period, then there will still be only one output 
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Figure 4.15 Bounce problems can be eliminated by triggering a monostable multi- 
vibrator to create the desired pulse. 


pulse. Since the bounce generally will subside well within the 500s time limit, 
this circuit gives a reasonable performance for its low cost. 


SOFTWARE COUNTERS 


In order to lower equipment cost even more, you can always perform addi- 
tional functions using software. The counters discussed earlier provide a good 
example of hardware that could be simulated using software. The Apple’s 
microprocessor is a 6502, which has two interrupt pins. One of these inter- 
rupts is a non-maskable interrupt or NMI. Non-maskable means that any 
pulse on this pin will always cause an interrupt. In contrast, the other 6502 in- 
terrupt (IRQ) can be masked with software to allow or not allow interrupts to 
be accepted. 

When an interrupt is accepted by the Apple, the program presently being 
run is stopped momentarily and a second program is executed. Figure 4.16isa 
short machine language program that can simulate two 8-bit counters using 
the 6502 interrupt pins as inputs. Let’s look at the program to see how it 
works. 

The first portion of the listing equates labels to the fixed addresses to be 
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REV .COUNTER 


L000 RAAKRKRAARARARKARAKRKRAREARAARE 
1010 %* REVOLUTION COUNTER *% 


1020 * BY JOHN BLANKENSHIP *% 
1030 ®RARKRKKARARARAAARAARAKRRARAKKR 


0000- 1040 IRQCNT .EQ $0 
oo00ol- 10530 NMICNT .EQ $1 
FCA8- 1060 WAIT .EQ sFCA8 
O3FE- 1070 FRQLOW .EQ $S3FE 
O3FF- 1080 IRQHI -EQ s3FF 
O3FC- 1090 NMILOW .EQ $3FC 
O3FD- 1100 NMIHI -.EQ s3FD 
1110 -OR $300 
1120 *------------------ 2 eee cere 
1130 * INITIALIZATION SUBROUTINE 
1140 *-------------------------------- 
O300- A® 16 1150 INIT LDA @#IRQ SET UP IRQ VECTOR 
0302- 8D FE 03 1160 STA IRQLOW 
O305- AS O03 1170 LDA /IRQ 
0o307- 8D FF 03 1180 STA IRQHI 
O30A- AY ZO 1190 LDA #NMI SET UP NMI VECTOR 
o30C- 6D FC 03 1200 STA NMILOW 
O30F- AY O03 1210 LDA /NMI 
O311- 8D FD 03 1220 STA NMIHI 
O314- 58 1230 CLI ENABLE INTERRUPTS 
O315- 60 1240 RTS ALL DONE 
1250 *-~------------ ee fe ee ec errr rcrrcce 
0O316- EG O00 1260 IRQ INC IRQCNT 
0318- ASX Z8 1Z70 LDA #$28 PAUSE 
O31A- 20 ASB FC 1280 JSR WAIT 
O31D- AS 45 1290 LDA $45 RESTORE ACC. 
O31F- 40 1300 RTI ALL DONE 
13910 %*------------- 9-2 eee ccc ccc srr 
03Z20- EG Ol 1320 NMI INC NMICNT 
O3Z2Z2- 40 1330 RTI ALL DONE 
1340 *---------------- 9-5-2 rocco rrrrcce 


Figure 4.16 This short program (REV.COUNTER) can replace two 8-bit counters 
and two I/O ports. 


used. This makes the listing easier to read. The function of the next portion is 
to tell the 6502 where the programs are that we want to execute when an inter- 
rupt occurs. It also clears the interrupt flag so that the IRQ will allow inter- 
rupts. Lastly, there are the two programs. Each one is named for the interrupt 
line that will cause it to run. 

Let’s look first at the NMI interrupt program because it is easier than the 
IRQ. When it is run, it increments location NMICNT, which was equated to 
location 1. After doing so, the RTI instruction causes a return to the program 
that was running before the interrupt. As you can see, location 1 now serves as 
a counter. It will be incremented each time a pulse is applied to the NMI line 
found on pin 29 of any Apple slot. We can clear the counter with a POKE 1,0 
or see its contents with PRINT PEEK(1). 

The IRQ program is slightly more complicated. The NMI line will cause 
an interrupt whenever it receives a transition from a high to a low. This is 
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called edge-triggered. The IRQ is /evel-triggered because it will interrupt 
any time the line is low, not just when it goes low. This means we must wait un- 
til the pulse is finished before we return to the main program. If we don’t wait, 
the low level still on the IRQ line will cause a second interrupt from the 
original pulse. To solve this problem I used the WAIT routine in the Apple 
monitor to provide the proper delay. 

The next line loads the accumulator with the contents of location $45. 
This is required because the Apple monitor stored the original accumulator 
there before 1t came to our IRQ program. We must always make sure that 
none of the 6502 registers are destroyed by the interrupt program. Since we 
never know when an interrupt is going to occur, we never know what the main 
program is using the registers for. If they are not restored to their original 
values, the effect on the original program could be disastrous. 

Pulsing the IRQ line (pin 30 of the Apple slots) will increment location 0. 
You can also access the NMI and IRQ interrupts on pins 6 and 4 of the 6502 
using small clip leads if you find that more convenient. 


ENTERING THE PROGRAM 


The next step is to try out the program just discussed. Since the program is 
short, it can be entered easily from the keyboard. CALL-151 to get to the 
monitor and type 300:A9 16 8D... using the hex numbers from Figure 4.16. 
Of course if you have the disk, it’s even easier, Just type BLOAD REV.CNT. 
I should also point out that the optional diskette also contains the source code 
(S-C Macro Assembler format) for all machine language programs. The S-C 
Macro Assembler can be purchased from: 


S-C Software Corporation 
P.O. Box 280300 

Dallas, Texas 75228 

(214) 324-2050 


The assembler is needed only if you wish to modify my programs. Other- 
wise, just use the object files. They are identified by adding the .ML suffix to 
the name of the source file. Typically, the object files are BRUN by a controll- 
ing BASIC program. Figure 4.17 is a test program that shows how this is done. 

Build two circuits as in Figure 4.14 and connect them to the interrupt 
lines. You don’t need the gears yet. Just break the beam with a piece of paper. 
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COUNT .TEST 


5S PRINT CHR$ (4)"BRUN REV.COUNTER .ML" 

10 HOME 

15  POKE 0,0: POKE 1,0 

20 VTAB 5 Figure 4.17 This test program 


30 PRINT “IRQ", "NMI" (COUNT.TEST) will display the total 


40 VTAB 7 b f hat h d 
50 PRINT PEEK (0), PEEK (1)" number of counts that Nave occurred at 


60 GOTO 40 each interrupt pin. 


Run RUN CNT.TEST or type in Figure 4.17. Each time a beam is broken and 
restored, the appropriate number will increment on the screen. Once you have 
the interrupts working, the arm built, and an appropriate drive circuit for the 
motors, then the next step is to connect the drive circuit to the computer. For 
that we will need an I/O port. 


INPUT/OUTPUT PORTS 


There are many manufacturers of I/O ports for your Apple. Throughout this 
text I will use the John Bell Engineering VIA card. It can be purchased from: 


John Bell Engineering INC. 
1014 Center Street 
San Carlos, CA 94070 


The card has four bidirectional 8-bit ports and offers an excellent price/per- 
formance ratio. Even though the board has two 6522 VIA’s, I will only be us- 
ing the one on the back edge of the card. The 6522 has sixteen major registers, 
but I will be using only the first four. Because of this, you should be able to 
substitute any I/O port that you have available with only minor modifications 
to my programs. The four registers I will use and their addresses are shown 
below. These addresses are valid for a card in slot 4. 


Register Function Addr.(hex) Addr.(dec) 
DB Data Port B C480 50304 
DA Data Port A C481 50305 
DDB Data Direction B C482 $0306 
DDA Data Direction A C483 50307 


The actual output ports are DA and DB. Port A on the John Bell card is 
accessed through the 16 pin socket near the top of the board. The socket for 
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Port Bis at the bottom. There are also two sockets at the front edge of the card 
for the second VIA chip. 

The ports on the 6522 VIA are very versatile and very easy to use. Each 
individual pin may be used as an input or an output depending on the value of 
the corresponding bit in the associated data direction register. Perhaps an ex- 
ample can make this as simple as it is. Suppose we store the number $0F into 
DDA. This could be done from BASIC with POKE 50307,15 because hex 
number F is equal to 15 decimal. It is also equal to 00001111 in binary. 

This action will now cause the top four bits, called the upper nibble, of 
Port A to be input pins and the lower nibble to be output pins. Any combina- 
tion of input and output may be used, depending on your requirements. Let’s 
see how we can use the VIA output pins to control the two motors of our X-Y 
arm. The full implementation of my arm uses the following pins on Port B. 


Socket Pin Direction Function 

1 (LSB) out Horz. motor, forward/reverse 
2 out Horz. motor, on/off 

3 out Vert. motor, forward/reverse 

4 out Vert. motor, on/off 

5 out Solenoid to lift hand, on/off 

6 out Magnet held in hand, on/off 

7 in Horz. limit switch 

8 (MSB) in Vert. limit switch 


As you can see, the first four bits would connect to one of the several 
types of motor drive circuitry discussed earlier. Similarly, the next two bits 
would activate transistors or relays to control the hand itself. The last two pins 
connect to limit switches as shown in Figures 4.18 and 4.19. These switches 
can be used by the computer to find the ‘‘home’”’ position of the hand. The 
computer would need only to turn on each motor in the direction of the limit 
switch and then turn them off again when the port shows the switches have 
closed. 


5V 
10K 


COMPUTER _ Figure 4.18 Small switches allow the 
LIMIT INPUT PIN computer to sense when the arm has 
SWITCH 


7 reached predetermined limits. 
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Figure 4.19 Limit switches are mounted so that they will close when the arm nears 
the end of its travel. 


PLOTTING WITH THE ARM 


In order to demonstrate how to use the arm, I will show you howto turn it into 
a plotter. To keep things simple, this application will only require the lower 
four bits of the port. The only action required by the hand will be to hold a felt 
tip pen. For this example, it will not be able to lift it. For the following discus- 
sion, refer to the program in Figure 4.20. 

The overall function of the program is to plot lines according to the 
DATA statements. Figure 4.21 shows the direction that the arm will move 
when it reads the numbers shown. The last number in the DATA statements 
must be a — 1 to tell the program to stop plotting. 

The heart of the program is made up of the eight subroutines that move 
the arm in each of the eight possible directions. Let’s examine a couple of 
these routines to see how simple they are. The first routine is at line 1000 and 
moves the hand left. First location 0, which is the pulse counter for the hori- 
zontal motion, is set to zero. Next, address D, which is port B, is set to decimal 
2. In binary, 2 would be 00000010. The bit that is a 1 will turn on the horizon- 
tal motor so that it moves the hand left. To move the arm right, the port must 


Plotting with the Arm 
XY .PLOT.DEMO 
10 D ws» 12 * 4096 + 236 «+ 1 + 8 * 16 
20 DD »® D+ 2 
30 POKE DD,.63: REM INIT DATA DIRECTION 
40 POKE D,48: REM EVERYTHING OFF 
5O N = 8 
60 M = SQR (N A 2@+WN A 2) 
100 READ A: IF A ¢ O THEN END 
110 ON A GOSUB 4000,3000,2000,1000,5000,6000,7000,80 
00 
120 GOTO 100 
1000 REM MOVE LEFT 
1005 POKE 0,90 
1010 POKE D,50 : 
1020 IF PEEK (0) < N THEN 1020 
1030 POKE D,48 
1040 RETURN 
2000 REM MOVE DOWN 
z2005 POKE 1,0 
zZ010 POKE D,56 
2020 IF PEEK (1) < N THEN 2020 
2030 POKE D,48 
2040 RETURN 
3000 REM MOVE RIGHT 
3005 POKE 0,0 
3010 POKE D,51 
3020 IF PEEK (0) < N THEN 3020 
3030 POKE D.48 
3040 RETURN 
4000 REM MOVE UP 
4005 POKE 1,0 
4010 POKE D,60 
4020 IF PEEK (1) < N THEN 4020 
4030 POKE D,48 
4040 RETURN 
$000 REM UP-RIGHT 
3005 POKE 0,0: POKE 1,0 
53010 POKE D,63 
3020 IF PEEK (0) + PEEK (1) «< M THEN 5020 
5030 POKE D,48 
3040 RETURN 
6000 REM DOWN-RIGHT 
600s POKE 0,0: POKE 1,0 
6010 POKE D,589 
602Z0 IF PEEK (0) + PEEK «(1)> « M THEN 6020 
6030 POKE D,48 
6040 RETURN 
7000 REM DOWN-LEFT 
7005 POKE 0,0: POKE 1,0 
7010 POKE D,58 
7020 IF PEEK (@) + PEEK (1) <«< M THEN 7020 
7030 POKE D,48 
7040 RETURN 
8000 REM UP-LEFT 
8005 POKE 0,0: POKE 1,090 
8010 POKE D,62 
8020 IF PEEK (0) + PEEK (1) < M THEN 8020 
8030 POKE D,48 
8040 RETURN 
9000 REM DATA J 
g90o10 DATA 3,7,3,7,3,7,4.%,8,4,8,4%,1 
9020 DATA 6,1,8,1,1,1,5,1,5,1,53,5,2 


Figure 4.20 XY.PLOT.DEMO 
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9030 DATA 5,2 
9040 DATA 3,3, 
9050 DATA 3,7, 
9060 DATA 5.53,24 
9070 REM Oo 

90860 DATA 5 

9090 DATA 2 

9100 REM H 

9110 DATA 35,.2,5,5.,.5,1,1,1,1,8,7,39 
9120 DATA 3,3,3,3,3,3,3,7,3,3,3,7 
9130 DATA 1,1,5,1,53,2,2,2,6,3,3,3 
9140 DATA 7,2.,.5 

9150 REM N 

9160 DATA 5 

9170 DATA 1 

9180 DATA 2 


Figure 4.20 (cont.) 


receive the data 00000011 or decimal 3 (see line 3010). The motor is left on un- 
til the counter becomes equal to or greater than a preset number N. 

To move the hand at a diagonal, two motors must be turned on at the 
same time. Line 6000 begins a subroutine that will move the arm to the right 
and down. It sends the decimal number eleven (00001011 binary) to the port to 
turn on both motors, one forward and one reverse. To make things simple, 
my program assumes that both motors are turning at the same speed, which 1s 
pretty much true. When the sum of both counters is greater than or equal to 
the number M, then both motors are turned off. 

The variable M was set equal to the square root of twice the square of N. 
In other words, M is the length of the hypotenuse of a triangle whose sides 
have a length of N. By making N larger or smaller, the figure being plotted will 
vary in size. Figure 4.22 shows an actual plot made by my arm using the data 
statements shown in the program listing. The size of this plot can be changed 


Figure 4.21 The numbers in the plot Figure 4.22 The inaccuracy of this plot is due to 
program’s DATA statements will cause wobble and play in the ‘‘hand’’ connection. 
movement in the directions indicated 

above. 
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by using different values for the variable N. This capability is shown in Figure 
4.3. 


SUGGESTIONS FOR FURTHER STUDY 


You now have enough information to control the mechanical arm with the 
blocks world program developed in Chapter 3. It is actually a lot easier than 
you might think. First, you need to lay out a grid on the arm’s working surface 
to match the one used by the videobot. You will also need three blocks that 
can be manipulated. They should be made of metal so that a magnet will pick 
them up, and they should be as thin as possible so that the magnet will rest on 
one block as easily as it rests on a stack of three. If you don’t have any sheet 
metal you can cut squares from the tops of tin cans. 

We will leave the entire blocks world software intact, including the 
videobot program itself. It will serve as the memory for our system. After all, 
why duplicate all its functions in another program if we don’t have to? You 
will, however, have to add several routines to the videobot program so that the 
mechanical arm will move every time the simulation does. Let’s look at one 
specific example to get you started. 

Whenever the videobot gets the command N, it jumps to line 51000. A 
check is made at line 51020 to see if it is possible to move north. If it is, the pro- 
gram continues at the next line and performs the movement. Add a line 51021 
with a GOSUB to a routine that moves the real arm ‘‘NORTH”’’ using the 
techniques studied in the plot program. The number of counts that the arm 
should move is based on the size of your grid. 

You will also need to add routines for SOUTH, EAST, and WEST. In 
addition, the P and R commands must turn the electro-magnet on and off as 
well as raise and lower the hand. You could use the limit switches to detect the 
upper left position of the arm when it receives the command to initialize. Ini- 
tialization should also set up the data direction registers and make sure the 
motors are turned off. When you are finished, the videobot and the 
mechanical arm will move in unison to organize the blocks according to your 
bidding. When you complete everything in this chapter, move onto Chapter 5 
to see how vision can be added to allow the mechanical arm to locate blocks on 
its own. 


Vision 
Systems 


TYPES OF VISION 


Giving a computer vision can be an enormous task. This is especially true if we 
mean vision in the human sense. When we view a three-dimensional scene the 
brain engages in an enormous amount of processing. It must be able to sepa- 
rate the picture into its different parts by determining edges and corners. The 
brain must use shading information to understand depth and contour. Our in- 
ternal computer also makes assumptions about the portions of objects that 
are blocked from our view by other objects. 

We have the ability to recognize objects regardless of their orientation or 
size. Our vision can be obscured by fog causing a blurred or noisy picture. The 
ability to give this type of vision to a computer is becoming possible, but you 
should not expect to be able to perform such feats of processing on a personal 
computer. This does not mean that the personal computer cannot be used to 
give vision to our experimental robots. 

If the pictures to be used are restricted properly, an Apple or any other 
computer can provide adequate vision for the robot arms presented in this 
book. We want these restrictions to be as harsh as possible, as long as they still 
allow for a usable system. Let’s examine some of these restrictions. 


RESTRICTIONS AND LIMITATIONS 


We must begin by choosing how a camera, which will become the eyes of our 
machine, will view the work area. Figure 5.1 shows one possible method for 
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CAMERA 
5 a 


Figure 5.1 Mounting a camera above 
the work area is only one method of 
providing vision for a robot arm. 


mounting the camera. In this case, the work area is a rectangle or square in 
front of the robot. I will assume that the arm can be moved out of the picture 
by the computer. This means that the picture to be analyzed contains only the 
work area and the object in question. 

This brings up another restriction. Only one object will be allowed in the 
area to be analyzed. The object (or at least any special markings on it) must 
provide a high degree of contrast with the work area surface. For example, the 
work area may be painted flat black while the objects could be a gloss white. If 
you wish to experiment with several objects, you might use identical white 
wooden blocks with different black designs painted on their tops. 

These designs become our next restriction. They, too, must be of high 
contrast and void of shading. They must also be line drawings, that is they 
should show only the outline of the design. Some examples that come to mind 
are triangles, squares, and circles. In our first example, it will be required that 
our chosen designs must always have the same orientation and that their size 
will not vary. We shall soon see that such a restriction is not overly confining 
for our purposes. For those of you who wish to explore vision a little more 
deeply, I will provide a second, more generalized example, later in this 
chapter. 


OBJECTIVES 
In presenting my two examples of computerized vision, I want to keep three 


objectives in mind. First, I want to approach the subject of vision in such a 
manner that you will be able to utilize almost any camera system you now have 
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or plan to purchase. Later in this chapter I will review two camera systems that 
I have used, but I don’t want to restrict your experimentation to only the 
equipment that I own. 

My second objective is to make sure that everything I present is practical 
and that it can be easily repeated by the reader. I will stress the principles so 
that you can expand and adapt everything to any robot you wish. 

Lastly, I want to keep the software in BASIC even though it will some- 
times be terribly slow. BASIC will allow the principles to be more readily un- 
derstandable, and most readers should be able to experiment easily by 
modifying the programs for their own purposes. More advanced readers can 
convert portions of the programs to machine language if speed is important. 


A SIMPLE EXAMPLE 


As stated earlier, my first example, called VISION.1 on the optional diskette, 
will assume that the objects in question are always the same size and orienta- 
tion. For the time being, we will not worry about using a camera to provide 
our pictures. That will come later. This program will provide pictures for us 
on the low-resolution graphics screen. The screen will then be analyzed to 
determine if there is an object present, where the object is located, and what it 
is. 

Let’s bypass all the formalities and run the program to observe it in ac- 
tion. If you have the diskette, just RUN VISION.1, otherwise, type it in from 
the listing in Figure 5.2. When the program is run, you will be asked if you 
want the objects to be distorted. For now, answer no. This will give you a 
flashing dot on the graphics screen. Use your game paddles to position the dot 
where you want the object to be. 

Press the button on paddle zero to indicate you are ready. The computer 
will prompt you to select an object. The objects in this example look like the 
letters A, B, C, and D. Choose one of the letters to see what I mean. The ob- 
ject will be drawn and then the word SEARCHING will appear to indicate 
that the program Is looking for the object. When it is found, the word COM- 
PARING will be printed. The program will compare each dot in the object 
with ‘‘pictures’’ of what each object looks like. These “‘pictures’’ are referred 
to templates. 

Try each of the objects so that you know what they look like. If you 
select the distortion option, a random percentage of the dots that make up the 
object will be left out. Even when the object is distorted, the computer is able 
to identify it correctly most of the time. When it does make a mistake, I think 
you’ll agree with the computer that the distortion was so bad that the letter 
looked very much like the one guessed. 


A Simple Example 


VISION.1 


40 REM 33-2624 e2seoe6e4-eeeeee ! 
20 REM |! INTRODUCTION TO VISION | 
30 REM ! BY JOHN BLANKENSHIP $$! 
40 REM boson ceeeescocesesseeeess [ 
50 REM 


100 GOSUB 2000: REM INIT 

110 GOSUB 3000: REM SELECT AN £Z,.Y 

115 HOME 

120 PRINT "WHAT OBJECT (A,8,.C,D) “;: GET A 


121 IF AS = "A" THEN N #= 1: GOTO 130 
122 IF AS® = "B" THEN N = 2: GOTO 130 
123 IF AS = "C" THEN N = 3: GOTO 130 
124 IF A$ = "D" THEN N #® 4: GOTO 130 


129 PRINT CHR$ (7): GOTO 120 

130 GOSUB 1000: REM DRAW SELECTED OBJECT 

140 GOSUB 4000: REM LOCATE OBJECT 

150 GOSUB 5000: REM IDENTIFY OBJECT 

160 PRINT "HIT ANY KEY TO TRY AGAIN "; 

170 GET A$ 

180 RUN 

1000 REM }---------~------+--- ! 

1010 REM ! DRAW OBJECT N AT ! 

1020 REM ! POSITION X,Y 

1030 REM | ------------------- ! 

1040 P = 0 

1045 COLOR= 15 

1050 FOR TY = ¥ TO Y¥ + 6 

1060 FOR TX = X TO X + 4 

1070 PLOT TX,TY 

1080 NEXT TX,TY 

1090 COLOR= 0 

1100 FOR TY = ¥ 

1110 FOR TX = X 

1120 P = P + 1 

1125 IF RND (1) * 10 ¢ 3 AND FLAG = 1 THEN 
1140 

1130 IF OBJ(N,P) = 1 THEN PLOT TX,TY 

1140 NEXT TX,TY 

1150 RETURN 

2000 REM !----------~----~----- ! 

2010 REM ! INITIALIZE ! 

2020 REM bases 5-2265455e-eee= ' 

2030 DIM OBJ(4,15) 

2040 GR 


+ 1 TO Y¥Y + § 
+ 1 TO X + 3 


2050 HOME : VTAB 21 

20352 PRINT “DO YOU WISH THE OBJECTS TO SBE 
DISTORTED (Y/N) "“;: GET A$ 

2054 IF AS = "¥" THEN FLAG #® i 

20356 HOME : PRINT "USE PADDLES TO POSITION 


- PRESS BUTTON OWHEN YOU ARE AT CORRE 
CT POSITION." 
2060 FOR N =» 1 TO 4 
2070 FOR P #» 1 TO 15 
2080 READ OBJ(N,P) 
2090 NEXT P,.N 
2100 RETURN 
2110 DATA 0,1 
2120 DATA 1,0 
2130 DATA 0,0, 
2140 DATA 0,0 


1,1,0,1,1,1,1,1,0, 
-0,1,1,1,1,0,1,1,1, 
-0,1,1,1,1,0,0,1,1, 
1,1,1,1,1,U,1,1,1, 


g 


> pe hee 


Figure 5.2 VISION.1 
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3000 REM ! =--------------+------ ! 

3010 REM ! SELECT POSITION ! 

3020 REM !-------------------- ! 

3030 COLOR= 0: PLOT X,Y 

3035 xX = INT ¢ PDL (0) / 7.3) 

3040 Y = INT € PDL (1) ¢ 7.535) 

3042 cOLOR#= 15: PLOT X,Y 

3050 IF PEEK (49249) <«¢ 128 THEN 3030 
3060 RETURN 

4000 REM !---------------+---- ! 

94010 REM ! SEARCH FOR OBJECT ! 

4020 REM ! ----~--------------- ! 

4024 PRINT 

94025 PRINT "SEARCHING" 

9030 FOR X = 0 TO 34 

4040 FOR ¥ = 0 TO 32 

4050 IF SCRNC X,Y?) = 15 THEN RETURN 
4060 NEXT Y,X 


4070 PRINT "“ERROR-OBJECT NOT FOUND": END 
5000 REM ! ------------------ ! 
9010 REM ! DETERMINE OBJECT ! 


3020 REM !------------------ ! 

53025 PRINT "COMPARING" 

$030 FOR N = 1 TO 4 

5035 NCCN) = O 

3040 P = O 

53050 FOR TY = Y + 1 TO Y 

3060 FOR TX =» X + 1 TO X 

29070 P= P + i 

53080 IF SCRNC( TX,TY) = 0 AND OBJ(N,.P) = 1 
THEN NCCN) = NCCN)D + 1 

2085 IF SCRNC TX,TY)? = 1353 AND OBJ(N,P) #& 
O THEN NCCN)D = NCCN)D + 1 

53090 NEXT TX,TY,N 

3100 REM AT THIS POINT, NCC(N) CONTAINS 

9110 REM THE NUMBER OF CORRECT MATCHES 

3120 REM NOW FIND WHICH ELEMENT IS THE 

9130 REM LARGEST AND PRINT ANSWER 

$140 ANSWER «= 1 

9145 TEMP = NC(1) 

531350 FOR I =x 2 TO 4 

2160 IF NCCI) >» FEMP THEN TEMP = NCCI): ANS 
WER = I 

53170 NEXT IB8 

53180 HOME 

7190 PRINT "THE LETTER ON THE BLOCK WAS '" 


’ 


+ 3 
+ 3 


9200 IF ANSWER = 1 THEN PRINT "A'‘" 
59210 IF ANSWER = 2 THEN PRINT "B'°" 
3220 IF ANSWER x 3 THEN PRINT "C'" 
3230 IF ANSWER = 4 THEN PRINT "D'" 
39240 PRINT "IT IS LOCATED AT "X + 2","Y + 


3 
5250 RETURN 


Figure 5.2 (cont.) 


PRACTICAL USES 


Unless I miss my guess, the average reader is thinking, This is interesting, but 
how can I use such a program? That’s a good question, and the answer is 
easier than you might think. Most camera systems for the Apple will place the 
information they collect onto one of the graphics screens. Using the results of 
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my program, you will know the position of the object on the screen. A simple 
scaling factor can translate the screen coordinates into a position on the work 
area for the robot. 

Figure 5.3 shows how scaling factors can be used. The objective is to find 
a formula that relates the points XP, YP and XG, YG. Since the relationship 
between the two points is linear, we can assume that there are some numbers A 
and B that will make the following equation true. 


XP=A*XG+8B 


In order to find the values for A and B, we need two known values. When XP 
is 0, XG should be 30. When XP 1s 8.4 we want XG to be 230. By substituting 
into the original equation, we get two new equations. 


0=A*30+8B 
8.4= A*230+ 8B 
If the first equation is solved for A and the results substituted into the second 
equation, we can find the value of B. We can then use the value for B and the 


first equation to find the value of A. If you do so, you will find the following 
values. 


A = .042 
B= —1.26 


This means that the following equation gives the relationship between X 
values in the two areas. 


XP = .042* XG — 1.26 


You can follow the same procedure and find the relationship between corre- 
sponding Y values in the two areas. 
A very inexpensive vision system using these principles could be devised 
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Figure 5.3 Simple linear functions can be used to map a graphic image onto a 
physical work area. 
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for the X-Y arm discussed in Chapter 4. Eight photo-resistors or photo-diodes 
could be mounted in a straight line on the hand and interfaced to a parallel in- 
put port (see Figure 5.4). As the hand is moved over the squares where objects 
might be located, the computer can read the port and store the on/off data in 
an array or transfer it to the screen. 

Hopefully, you now feel that such a simple program really can be useful. 
Now that I have your interest, let’s examine the program to see how it works. 
The program is very modular and easy to follow. Line 100 initialized the 
system by activating the module at 2000. This module starts by creating a two- 
dimensional array called OBJ(N,£) that holds the templates for the known 
objects. N is used to indicate the number of the object we wish to compare, 
while E represents one of the fifteen possible elements that make up a letter. 
Figure 5.5 shows how these fifteen elements are used to make the letter A. 

After the program finds out if you want to use distortion or not, it reads 
the templates for the four objects into the array. Line 2110 contains the de- 
scription of an A if you would like to compare it to Figure 5.5. Next, line 110 
executes the module at 3000, which lets you use the game paddles or a joystick 
to select where the object should be created. 

Lines 120 through 129 let you select which object to create. The 
subroutine at 1000 is called to actually draw the object. At this point, we can 
actually start the recognition process. The module at 4000 uses the screen read 
function, SCRN, to examine the area where objects could reside. This process 
is actually looking for the upper left-hand corner of the block, which is always 
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Figure 5.4 A row of photo cells could 
% be mounted on the manipulator and 
read by the computer as the X-Y arm 


moves Over each square on the work 
= area. | 
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Figure 5.5 A 15-element array is used 


to hold the image of the letters to be 
identified. 


white (color = 15). Since all object blocks are five dots wide and seven dot: 
deep, the center of the object is equal to X¥+2 and Y+3, where X and Y are 
the coordinates of the upper left-hand corner of the block. 

Once the object is found, it is identified by the module at 5000. A FOR 
loop starting at 5030 is used to compare the fifteen dots that make up the 
character area of the block on the screen to each of the four templates. The 
variable P keeps track of which dot is being compared. 7X and TY are the 
coordinates of the dot on the screen that is being examined. The array NC 
holds the number of correct matches found. NC(1), for example, refers tc 
how many dots match when the screen is compared to the letter A. NC(2) 
holds the number of matches for B, and so forth. 

Starting at line 5140, the program finds which of the elements in NC is 
the largest, which of course will be the closest match. The correct block 
number is stored in the variable ANSWER. The correct object and its location 
is printed on the screen. 


COMPLICATING MATTERS 


In the previous example, the object to be identified always had to be vertical 
and exactly the same size. Even so, such a primitive system can be useful for 
many applications. I don’t think this chapter would be complete, though, 
unless I at least touched on a method that can remove some of these restric- 
tions. Before I discuss the algorithm, let’s run the program and watch it in ac- 
tion. It can be found on the optional diskette as VISION.2 and in Figure 5.6. 

When it is run, the program will expect you to use the paddles or a joy- 
stick to draw objects on the screen. The objects may be drawn to any size, to 
any Orientation, and even with dotted lines by moving the paddles faster than 
the screen can be updated. In order to be accurate, though, the program re- 
quires that there be a fairly large number of points in the object. This means 
that the bigger you make the object the better the chances are that it will be 
identified correctly. 
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VISION. 2 
REM tese2eeeeoceeeeeess ‘ 
REM ! VISION ALGORITHM ! 
HEM ! COPYWRITE JULY 83 | 
REM ! BY i 
REM ! JOHN BLANKENSHIP |! 
REM f-s<.c-nececoens ree 
REM 
REM fesse ececcesscteaaeu 
REM ! INITIALIZATION ’ 
REM feesesoeneseesolcee. ! 

DIM A(200),B(200),AVE(25) 
GR : COLOR= 15 


PLOT PDL ¢€0) / 7, PDL ¢1) / ? 

IF PEEK (49249) >» 127 THEN GOTO 115 
IF PEEK (49230) > 127 THEN 105 

GOTO 110 

PRINT CHR$S (4)"BSAVE OBJECT,A8#400,L84 
oo" 


REM !------------------ ! 

REM ! COLLECT POINTS t 

REM !------------------ ! 

PRINT "COLLECTING POINTS" 
N = 0O 


FOR X = 0 TO 39 

FOR Y = 0 TO 39 

IF SCRN¢( X,Y) = 1353 THEN N =# N + 1:AC 
N> = X¥:BC(N)D & Y 


NEXT Y,X 
REM fscsceieneceeenecte ‘ 
REM | FIND CENTROID ' 
REM 1 eo eeeen nee en canna f 


PRINT "FINDING CENTROID” 
Cx = 0:CY = QO 
FOR I = 1 TON 
CX = CX + ACID = AC1) 
CY = CY + BCI) —- BC1)d 
NEXT I 
CX m= (CX / ND + AC1) 
Cy = (CY / N>d + BC1) 
PLOT CXx,cy 
REM ! -----------2--"---- ! 
REM ! FIND ANGLE & MAG $$! 
REM !------------------ ! 
PRINT "CONVERTING TO VECTORS" 
FOR I =« 1 TON 
H = CY - BCI) 
B= ACI) -— CX 
BCI) -» SQR ¢(H A 2 + BA 2) 
IF B = Q AND H > O THEN ACI) = 1.3708 
GOTO 2210 
IF B = 0 AND H ¢«¢ O THEN ACI) ws» 4.7124 
GOTO 2210 
IF B = 0 AND H = O THEN ACI) = ACI - 
1>: GOTO 2210 
ACI) «= ATN ¢H / 8B) 


IF B ¢ 0 THEN ACI) = 3.1416 + ACI) 
IF ACI) ¢ 0 THEN ACI) = 6.2822 + ACI) 
NEXT I 

REM |-------------------- 1 

REM ! SORT BY ANGLE ' 

REM | 2¢<scec8e ences eoete ! 


Figure 5.6 VISION.2 
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PRINT "SORTING ANGLES" 

FOR J = 1TON - 1 

FOR I 28 1 TON - 1 

IF ACI) <¢ = ACI + 1) THEN 3080 
T w= ACID: ACID mw ACI + 1):ACI + 190 2 T 
T » BCID: BCID =» BCI + 1)9:B8¢1 + 190 2& T 


NEXT I,J 

REM (o--esssenseeee sees i 
REM | FIND MAX MAGNITUDE ! 
REM (ese - ere eee seeence 


PRINT "SEARCHING FOR MAX. MAC." 
MX = BC(1):P = 1 

FOR I = 2 TO N 

IF BCI) >» MX THEN MX = BCI): P = I 


REM |ecese464e5522-5525- ! 
PRINT "NORMALIZING MAG." 
FOR I = 1 TON 

BCI>) = BCI) / MX 


PRINT "NORMALIZING ANGLES" 
IF P = 1 THEN GOTO 6000 
T wm ACP) 
FOR I xs 1 TO N 
ACI) m» ACID - T 
IF ACI)? ¢ @ THEN ACI) = ACID + 6.2832 


REM fs<<ccseesen cee i 
PRINT “SEGMENTING DATA" 

FOR I = 1 TO 20:AVECI) #= O: NEXT I 
CNT = 0 


G =» 1 
M =» 6.2832 / 20 
I we P - 1 


FOR J #= 1TON 
I =» I + 1: IF I > N THEN I = 1 
IF ACI) < M THEN 6090 
Mes M + 6.2832 / 20 
IF CNT = 0 THEN AVECG) 2 0: GOTO 6086 


AVE(G) = AVE(G) / CNT 
CNT = 0:G = G + 1: GOTO 6075 
AVE(G) = AVE(G) + BCI) 
CNT = CNT + 1 
NEXT J 
AVE(20) = AVE(20) / CNT 
REM (o2426se2<cecenu ' 
REM ! GRAPH SEGMENTS ! 
REM (e26c6eseeenntcee 
GR 
COLOR= 15 
FOR I = 1 TO 20 
AVEC(I) = INT (20 *® AVECI)) 
VLIN 20 — AVECI),20 AT I 
NEXT I 
PRINT CHR$ (4)"BSAVE OBJECT.CRAPH,A$ 
400,L8400" 


Figure 5.6 (cont.) 
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8040 FOR I #» i TO 19 

8050 IF AVECI + 1) > AVECI) AND MODE = 0 THEN 
NEL = NEL + 1:MODE = 1: GOTO 8062 

8060 IF AVECI + 1) ¢ AVECI) AND MODE = 1 THEN 
MODE = 0O 

8062 IF AVECI>) < LOW THEN LOW = AVE(CTI) 

8064 IF AVECI> >» HIGH THEN HIGH =» AVECTI) 

8070 NEXT I 

8071 CX = INT (CX) :CY = INT ¢CyY) 

8072 IF MODE = 0 THEN NL = NE + 1 


8075 PRINT “THE OBJECT WAS AT “CX", "CY 

8076 IF HIGH - LOW ¢ =z 4 THEN PRINT "IT 
WAS A CIRCLE": END 

8080 IF NL = 4 THEN PRINT "IT WAS A SQUAR 
E": END 

8090 IF NL = 3 THEN PRINT "IT WAS A TRIAN 
GLE": END 

8100 IF NE = 2 THEN PRINT "IT WAS AN OVAL 

END 


8110 PRINT "BUT I CANNOT TELL WHAT IT WAS" 


Figure 5.6 (cont.) 


The program knows how to identify circles, ovals, triangles, and 
squares. The differences between circles and ovals are not always obvious to 
the user, since the Apple screen distorts the ratio of horizontal and vertical di- 
mensions slightly. You may erase your drawing and start over by pressing the 
button on paddle 1. Press button 0 when the drawing is ready to be analyzed. 

Since the program isin BASIC and the algorithm is very time consuming, 
the time required to identify an object is quite lengthy. The time increases with 
the number of points in the object, with an average analysis taking several 
minutes. Let’s look at the algorithm to see what this analysis involves. 

This algorithm will be far more complicated than the principles discussed 
for VISION.1. Refer to the flowchart in Figure 5.7 and the program listing at 
the end of this chapter as you read the following discussion. The VISION.2 
program first examines every point on the screen to see if itis ON or OFF. The 
coordinates of every point that are found ON are stored in two arrays. The _X 
coordinates are stored in the array A while the Y coordinates are stored in the 
array B. 


CENTROIDS AND VECTORS 


The next step is to locate the centroid of all these points. The centroid is the 
center of mass. If, for example, you drew the object on a piece of cardboard 


Centroids and Vectors 63 
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DATA 
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Figure 5.7 This algorithm can allow the 
computer to recognize two dimensional 
objects regardless of their size or orien- 
tation. 


and cut it out, it would balance on the end of a pin placed at the centroid. The 
position of the centroid is equal to the average X and average Y coordinates. 

Imagine that we now draw lines from the centroid to each point in the ob- 
ject. Each of these lines will be treated as a vector, that is they will each have 
an angle and a magnitude or length. Figure 5.8 shows the details of these vec- 
tors. Once the vectors have been calculated, they are sorted by angle. This 
sorting process effectively puts the vectors in the order that the points occur 
around the perimeter of the object. 

There is another method for getting the points in this order that is worth 
mentioning here. We could have searched the area around the first point 
found for another point, then searched around it for another. Continuing this 
process would enable us to find all the points in the order that makes up the 
object. This list of points is sometimes called chain code. My method for 
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CENTROID Figure 5.8 A vector is identified by its 


OBJECT magnitude (length) and its angle (rela- 
tive orientation). 


locating the points has an advantage over this method. The advantage of my 
method is that the outline of the object does not need to be a solid line. 

The list of magnitudes that we have compiled contains a lot of informa- 
tion. Let’s suppose, for a moment, that the object being analyzed was a 
perfect circle. If so, each of the magnitudes would be equal to the radius of the 
circle. If the object was an oval, then the magnitudes would be longer at the 
ends than at the middle. Figure 5.9 shows this, as well as how the magnitudes 
could be represented graphically. 

Our next step is to make sure that this graphic information will look the 
same no matter how large or small the object is. This is accomplished by find- 
ing the largest magnitude and giving it a value of 1. All other magnitudes will 
be reduced to a number between 0 and 1 by dividing them by the maximum 
length. This process is known as normalization. 

We also want the same object with different orientations to produce the 
same data. Effectively, this means that the graphic representation shown 
earlier must start at the same point on the object. I chose to start the graph at 
the vector with the largest magnitude. If there are several vectors with a nor- 
malized magnitude of 1, then I just use the first one in the list. It is possible 
that doing so can produce undesirable results, but in practice, it works quite 
well. The angle for this initial vector is normalized to zero and all the other 
angles adjusted by adding the corresponding offset. 


123 4 5 6 7 8 9 10 11 


Figure 5.9 The vectors that define an object can be arranged to form a graph. 
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CONDENSING THE DATA 


In order to condense the data before analysis, the vector list will be divided 
into twenty groups. Each group is made up of the vectors whose angles lie in 
the appropriate 4, of a 360 degree circle. In the Apple, we must perform these 
calculations in radians. Within each group, the vector magnitudes are aver- 
aged together. In this manner, any object is reduced to an ordered set of 
twenty numbers. Figures 5.10 through 5.14 show five objects and the graphs 
of the twenty numbers obtained from the analysis just described. These 
figures were obtained by dumping LORES screens after running VISION.2. 

If there are enough points in the objects to be identified by the computer, 
and if the object is not distorted except by rotation and scaling, then the nor- 
malized twenty numbers should be the same or very nearly the same each time 
an object is analyzed. We could save the description of what different objects 
look like and compare a viewed object to find the best match. 

I chose to use a more specific analysis that would also allow for distor- 


Figure 5.10 The graph for a triangle 
has three low points, one for each cor- 
ner. 
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Figure 5.11 Even a dotted triangle pat- 
tern produces a graph with three low 
points. 


Figure 5.12 A square has four low 
points. 
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Figure 5.13 An oval has two low 
points. 


Figure 5.14 Imperfect circles cause 
many small variations in the graph. 
Note that the aspect ratio of the Apple 


screen causes a real circle to look like an 
oval. 
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tion in the object’s image. A triangle for example, any triangle, will producea 
graph with three low points, one for each corner. A square with its four cor- 
ners will produce four low points. Figures 5.10 through 5.14 show this clearly. 
Notice that even a dotted triangle produces three low spots in the graph. 

An oval will produce two low spots in its graph. In the case of a perfect 
circle, the graph should be flat. If there is a large enough number of points, 
then a flat graph will indeed be the result. Because of the errors resulting from 
rounding low-resolution coordinates, though, most circles will produce a 
graph like the one in Figure 5.14. Even though there may be several low points 
in such a graph, it is easily identified as a circle by the fact that the graph varies 
only slightly from its highest and lowest magnitude. 

The VISION.2 program mentioned earlier is well commented so that you 
can follow how this algorithm is implemented. You may wish to convert por- 
tions of the program to machine language to speed up the recognition process. 
If you are uncomfortable with writing machine-language programs, there are 
numerous amper-extensions available commercially that can provide such 
useful utilities as high-speed sorts. Such utilities can be very useful, especially 
since sorting the vectors in VISION.2 is the most time-consuming portion of 
the program. 


VISION HARDWARE 


In the two examples of vision software previously discussed, it was assumed 
that the picture to be analyzed was on the low-resolution graphics screen. In 
order to give our robots physical vision, we need some means to convert real- 
world pictures into their graphics screen equivalent. I have used two types of 
camera systems that are capable of performing this function. 

The DS-65 Digisector from the Micro Works can convert the video signal 
from an ordinary television camera (like you might use with a video tape 
recorder) to a high-resolution graphics image. Figure 5.15 shows a rendition 
of yours truly from the DS-6S. 

Another type of camera system was featured in Steve Ciarcia’s articles in 
the 1983 September and October issues of Byte magazine. It is called the 
Micro D-Cam and is available from the Micromint. Because the Micro D-Cam 
uses a solid-state sensor, no external camera is necessary. It has roughly the 
same picture quality as the DS-65. 

Both of these hardware systems can provide satisfactory results for ex- 
perimenting with robot vision. The solid-state system offers several advan- 
tages. It requires less light than a conventional camera. It is also very light- 
weight so that it can be mounted directly on a modestly strong arm if desired. 
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Figure5.15 This rendition of yours truly was created by a DS-65 vision system from 
Microworks. 


Lastly, the images from a solid-state system are more repeatable than those 
from a standard TV camera. Let me explain what I mean by this. 

Suppose you were to securely mount a television camera so that it is fo- 
cused on a specific object. Each time you turn the camera off and back on 
again, you may find that the coordinates of the object have shifted slightly. 
This problem is inherent in the vidicon tube used by television cameras to 
form the image, but is not a problem with solid-state systems. 

Vidicon systems do have some advantages too. They are capable of pro- 
viding gray scale information much easier than similarly priced solid-state 
systems. Because of their lower sensitivity to light, vidicons are capable of 
providing decent pictures over a much wider range of light levels without read- 
justing everything. Additionally, I found the DS-65 much easier to focus. In 
fact, I found it far more user friendly in most every area. 


A HIRES SCRN FUNCTION 
Both of the hardware systems just discussed transfer their images to the high- 


resolution screen. Unfortunately, Applesoft does not have a HIRES 
equivalent of the LORES SCRN function. This absence makes it very difficult 
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for the average user to determine if a given point on the HIRES screen is ON 
or OFF. Fortunately, I have a solution for you. At the end of this chapter is a 
short machine language program called HIRES SCRN FUNCTION that pro- 
vides just that. 

You can enter it by hand using the Apple monitor. It must by initialized 
from BASIC using a CALL 768. Below are two lines to show how to use the 
HIRES SCRN from BASIC. 


(LORES) 1000 A = SCRN (X,Y) 
(HIRES) 1000 &A =X,Y 


In both cases, X and Ycan be variables, numbers or formulas. In the case 
of my HIRES function, the variable A will contain a 0 if the point is OFF 
(black) or a 1 if the point is ON (white). My HIRES function must be used 
only in the form given. You cannot, for example, perform the screen function 
in an IF statement. Instead, use something similar to the following lines. 


1000 &A = X, Y 
1010 IF A=1 then PRINT “The point was on” 


My screen function may not have the versatility of most Apple functions, 
but it is very short, and it will allow you to analyze HIRES images. If you have 
the diskette, you may just BRUN HIRES.SCRN.FUNCTION.ML to ini- 
tialize the function. HIRES SCRN FUNCTION is the source file in S-C 
Assembler format. If you do not have the diskette, refer to Figure 5.16. 


SUGGESTIONS FOR FURTHER STUDY 


Now that you have seen two methods for giving a computer the gift of sight, 
the next logical step is to put that knowledge to a practical use. The X-Y arm 
discussed in Chapter 4 can easily be adapted to utilize vision information from 
a camera using the techniques discussed in this chapter. Mount a camera 
directly above the work area. When a picture is being ‘‘taken,’’ the computer 
should move the arm to the far corner so that it will not appear in the screen 
image. Once the object and its location have been identified, translate the 
screen coordinates into the real work space coordinates by applying the ap- 
propriate scale factors. The only thing left is to use the knowledge you gained 
from Chapter 4. 

As the arms get more and more complicated in future chapters, the possi- 
ble use of vision will get more and more exciting. Once you feel comfortable 
with the information presented in this chapter, move on to Chapter 6 and ex- 
amine a simulation of a jointed arm. 


Suggestions for Further Study 
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EXAMPLE: 


. OR 
. TF 
. EQ 
. EQ 
. EQ 
.- EQ 
. EQ 
. EQ 
. EQ 
. EQ 
. EQ 
. EQ 
. EQ 
. EQ 
. EQ 
. EQ 
. EQ 
. EQ 
. EQ 
. EQ 
LDA 
STA 
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STA 
RTS 
JSR 
STA 
STY 
LDA 
JSR 
JSR 
JSR 
LDY 
LDA 
AND 
AND 
BEQ 
LDA 
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JSR 
RTS 


SCRN 


100 &A=x=X,Y 
WHERE X,Y ARE COORD. 
BRUN TO SET & VECTOR 
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#START 
AMPER 
‘START 


AMPER+1 


PTRGET 
FORPNT 


FUNCTION 


x 
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x 
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GET VAR 
SAVE ADDR. 
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SYNCHR 
HIRCOR 
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INDEX 


(BASE),Y 


MASK 
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#1 
FLTACC 
SETFOR 


CK FOR = 
READ COORDINATES 
CONVERT TO ADDR. 


GET HIRES BYTE 
CHECK PROPER BIT 
CLEAR COLOR BIT 


SHOW SET 

FLOAT ACC 

MOVE ACC TO VARIABLE 
BACK TO BASIC 


Figure 5.16 HIRES.SCRN.FUNCTION 
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A Simulated 
Jointed Arm 


WHY JOINTS? 


When the average person thinks about a robot arm, he or she thinks about an 
arm with joints, an arm much like their own. The reason such an arm was not 
covered first in this book is that a jointed arm is much more difficult to control 
than an X-Yarm. The work space of an arm Is usually best described with X- Y 
coordinates. When using a jointed arm, these _X- Y coordinates must be trans- 
formed into the corresponding joint angles. 

My objective for this chapter is to provide you with a program that can 
simulate an arm with two joints, a shoulder and an elbow. Such a simulation 
will allow you to develop software to control a jointed arm without the ex- 
pense and effort required to build one. The simulation will also provide valua- 
ble design information for building a real arm, which we will do in a later 
chapter. Any programs developed to control the simulation can also be used 
to control the real arm. For now, let’s concentrate on developing the simula- 
tion program. 


TRIGONOMETRY 


The main function of the simulation program is to draw a picture of the arm in 
its present position on the Apple HIRES screen. The known information will 
consist primarily of the angles of each of the joints. These angles and several 
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constants, such as the length of the arm and its starting point, must be used to 
locate the corresponding X- Y coordinates of the arm’s end-points. Once these 
points can be established, it is easy to draw the arm. 

Each time the arm is told to move a joint, the new angle will be used to 
calculate the new screen coordinates. The old picture will be erased and the 
new position redrawn. Let’s begin by examining the mathematics required to 
make these calculations. You will need to know a little about trigonometry. If 
you do not have a background in mathematics, let me assure you that this is 
not going to be as complicated as you might think. 

Figure 6.1 shows the trigonometry that we will need. It shows a right 
triangle, that is, one that has a 90 degree angle. If we know one of the other 
angles of such a triangle (in this case the angle A) and the length of the 
hypotenuse (R) we can easily find out the length of the other sides using the 
formulas shown in the figure. 

The geometry of the arm is shown in Figure 6.2. The coordinates of the 
elbow joint are X/, Y/ while the end of the arm is at _X, Y. Note that the values 
of X and Y can be calculated by using the appropriate sides of the right 
triangles formed by the arm segments. 


@ R-SIN (A) 
Figure 6.1 The sides of a right triangle 
can be found if you know the length of 
the hypotenuse and one of the acute an- 
R\COS (A) gles. 


ELBOW 
(X1, Y1)  Xy 


X=X, +X, 
PSN Ne 


Figure 6.2 A jointed arm can have various orientations as shown. The sign changes 
of X1 and Y1 can be automatically taken care of by the trigonomentry involved. 
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If you study the figure you will see that sometimes the calculations for 
forming X and Y involve adding two numbers. At other times the difference 
of two numbers is used. Actually, the two numbers can always be added be- 
cause the Apple SIN and COS functions automatically produce negative num- 
bers for the appropriate angles. 


CODING THE SIMULATOR 


If you refer to the program listing at the end of this chapter, you will see how 
these calculations can be implemented with BASIC. The actual simulator 
starts at line 60000 so ignore the earlier lines for now. The simulator expects its 
inputs from several variables. These variables and their definitions are listed 
below. 


Variable Value Function 
PEN ] Pen Up (don’t draw) 
0 Pen Down (draw as arm moves) 
ANGLE — Smallest step angle of joints 
(radians) 
ARM 1 Increment shoulder joint by ANGLE 
—] Decrement shoulder joint by ANGLE 
No change in shoulder joint 
ELBOW l Increment elbow joint by ANGLE 
—] Decrement elbow joint by ANGLE 
0 No change in elbow joint 


The calling program only needs to decide what angle changes are de- 
sired and to set the appropriate variables to reflect those desires. The simu- 
lator will take care of the rest. Lines 60060 through 60090 adjust the angles of 
the simulator’s joints (Al and A2) by adding or subtracting the value of 
ANGLE. 

The trigonometry formulas discussed earlier are used in lines 60170 and 
60180 to calculate the required X, Y coordinates. These values are used in the 
next section of the program to draw the arm on the screen. Depending on the 
value of PEN, the arm may leave a line as it moves. 


MANUAL CONTROL OF THE SIMULATOR 


Now that you understand how the simulator itself operates, let’s look at how 
easy it is to control manually. Look at the first portion of the program listing 
that we ignored earlier. It allows a joystick to guide the motion of the arm. It 
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starts by initializing the graphics screen and the appropriate parameters. The 
games ports are read to see if a joystick is at or near its center position. As long 
as it is, the values of ELBOW and ARM are left at 0 to represent no change. 

If the paddle inputs are near their extremes then ELBOW and ARM are 
set to 1 or — 1 so that the indicated angle will move forward or backward. The 
directions chosen by the program will move the arm roughly in the direction 
that you move the joystick. Try it by typing in the program in Figure 6.3 or 
RUN MANUAL.JOINTED on the optional diskette. The PADDLE 0 button 
can be used to control if the PEN is up or down. 


MANUAL. JOINTED 


5 PEN = - 1: GOSUB 60000 

10 PEN = O:ELBOW = 0:ARM = 0 

zo IF PDL (0) ¢«< 30 THEN ELBOW = - l 

30 IF PDL (0> >» 200 THEN ELBOW = 1 

40 IF PDL ¢1) ¢ 50 THEN ARM = 1 

50 IF PDL (1) >» 200 THEN ARM = - il 

60 IF PEEK ¢€ -—- 16287) >» 127 THEN PEN « 1 

65 GOSUB 60000 

70 GOTO 10 

60000 REM §------ - - - - - ee ee me em eer reer ! 

60010 REM ! JOINTED ARM VIDEO SIMULATOR ! 

60020 REM ! COPYRIGHT MAY 1982 BY ! 

60030 REM ! JOHN BLANKENSHIP ! : 

60040 REM | --------- ee ee ee erm errors ! 

60050 IF PEN = - 1 THEN GOSUB 61000: REM INITIALIZ 

60060 IF ELBOW = 1 THEN Al =» Al + ANGLE: GOTO 60080 

60070 IF ELBOW = - 1 THEN Al = Al —- ANGLE 

60080 IF ARM #= 1 THEN AZ = AZ + ANGLE: GOTO 60100 

60090 IF ARM = - 1 THEN AZ =» AZ - ANGLE 

60100 IF Al ¢ 0 THEN Al «= QO 

60140 REM f---—--- — - — — = ee ee ee ee ee ee eee eee ! 

60150 REM ! CALCULATE X-Y¥Y CO-ORDINATES ! 

60160 REM Pee ee ee ee ee ee en er ne nr ne ee mn eee J 

60170 XE = xS - R ® COS («Al):YE = YS - R ® SIN ¢Al) 

60180 X = XE + R ® COS (AZ):¥Y = YE - R ® SIN (AZ) 

60190 REM Pee ee ee ae ee en ee nr nr rer nr er er ee eee ee ee ! 

60200 REM ! REDRAW AND PLOT POINTS ! 

60210 REM !---—-- = --- = - 2 ee ee em ee er eer errr ree ! 

60220 IF DR = 1 THEN 60310 

60230 HCOLOR= 0O 

60240 HPLOT X¥S,YS TO xQ,YO: REM ERASE ELBOW 

60250 HCOLOR= 1 

60260 HPLOT xXxS,YS TO XE,YE: REM DRAW NEW ELBOW 

60270 HCOLOR= 0 

60275 HPLOT XO,YO TO XL,YL 

602860 HCOLOR= 1 

60290 HPLOT XE,YE TO X,Y: REM DRAW NEW UPPER ARM 

60300 HCOLOR= 3 

60310 IF PEN = 0 THEN HPLOT XL,YL TO X,Y: REM DRAW 
LINE AS ARM MOVES 

60320 REM ----NOW RESET OLD POINTS---- 

60330 XO =2 XE:YO = YE:XL 2 X¥:YL =&» Y 

60340 RETURN 


Figure 6.3 MANUAL.JOINTED 
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61000 REM Pee ee He ne ne ee ne ne ee ee ee ee ! 
61010 REM ! MAIN INITIALIZTION ! 
61020 REM Pomme ee ee ee ee ee ee ee ee ee ! 
61025 HGR :ANGLE = .02 

61030 R = 860:X¥S = 100:YS w= 15989: RETURN 
61035 DR = 1: REM DRAW ARM 

61040 REM ANGLE = STEP ANGLE OF MOTORS 
61050 REM R = LENTH OF JOINTS 

61060 REM XS.YS 2s STARTING POINT OF ARM 


Figure 6.3 (cont.) 


If you are using the arm to draw an object, you will notice that your 
drawing will be erased as the arm moves over it. In many cases, this won’t 
bother you. If you are doing a complicated drawing, though, you can cause 
the program to skip over the lines that draw the arm by setting the variable DD 
(don’t draw) to 1 in the initialization portion of your program. 

Use the arm to draw a square on the screen. You may find it harder than 
you think. Try different values for ANGLE and see the effects they have on 
your ability to control the arm. Once you have convinced yourself that it will 
take a computer to make this arm even draw a straight line, then turn to the 
next chapter and let your computer take over the job. 


latelligent 
Gontrol 

of the dointed 
Simulator 


MANUAL VS COMPUTER CONTROL 


In the last chapter, you discovered that it is very difficult to draw with a 
jointed arm under manual control. The human mind just cannot handle all 
the data, at least not fast enough to control the arm at any reasonable speed. 
The computer on the other hand is perfect for this type of task. The goal for 
this chapter is to design a program that can move the arm between designated 
points in the work area. 

In order to accomplish this goal, you will need to master several tasks. 
The first of these is the ability to convert any X- Y coordinates in the work area 
into their corresponding joint angles. Note that this is exactly opposite of the 
operations required in the simulator program. We will also see that converting 
coordinates to joint angles is much more difficult than converting angles to 
X-Y coordinates. 

Once the joint angles of the new position are known, we must determine 
how many steps of each joint will be required to arrive at the desired destina- 
tion. Finally, an algorithm must be found that can step each joint at its own 
speed so that all joints will finish at the same time. This action will cause a 
smooth, fluid motion between the two points. Let’s begin by reexamining our 
rules of trigonometry to see how any point can be converted to its correspond- 
ing joint angles. 
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FINDING THE JOINT ANGLES 


The conversion process will, as it did in Chapter 6, involve the mathematics of 
right triangles. Refer to Figure 7.1 for an explanation of the new formulas that 
will be necessary. Figure 7.2 shows the arm itself in two different positions in 
order to represent the possible situations. 

The given information consists of R (the length of each arm joint) and 
the X-Y coordinates of the end of the arm. The desired angles to be found are 
A3 and A4, although many other angles must be found first. We start by 
determining that 

TAN (Al) = Y/X 
or 

Al = ATN(Y/X) 
We also know that 

S1= VX? + Y: 
After we know S1, then we know 

S2 = $1/2 

This gives us two sides to another right triangle, and it’s clear that 


S3 = VR? — S?2 


. . A= kerry 
A=ATN(<) _. 

xX Figure 7.1 The use of the inverse tan- 
gent function provides a means to con- 
vert coordinates into an angular 

x measurement. 


Figure 7.2 The ‘‘backwards’’ solution 
for the arm geometry allows us to find 
the values for 43 and A4 when the X-Y 
position is known. 
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Knowing $2 and S3 enables us to determine the angle A 2 using the formula 
A2 = ATN(S3/S2) 


Since A 1, A2, and A3 must add up to 180 degrees or z radians, we can deter- 
mine our first joint angle A 3 using the formula 


A3 = 3.1415 — Al — A2 
Knowing the angle A 3 allows us to determine the sides of another triangle. 
S4 = R SIN (A3) 
SS = R COS (A3) 
Using the values for $4 and S5, we can determine the sides of another triangle. 
S7=X+S5 
S6= Y— S84 


The value of S4 obtained earlier may be either positive or negative. This 
causes the equation for S6 to work for any situation. We now have all the 
necessary information to calculate the final joint angle A 4. Generally, the for- 
mula to use 1s 


A4 = ATN(S6/S7) 


The only time this is not a valid computation on the Apple is when $4 and Y 
are equal. When this occurs, A 4 must equal 0. 


CONVERTING TO STEPS 


Now that the desired angle for each joint has been found, the next thing to do 
is determine how many steps each joint must move. Each step, as you remem- 
ber from the last chapter, is equal to ANGLE. The key to the solution is to 
always remember what angle each joint is at now. Wecan subtract the present 
position from the new angle to get how far the arm must move. Dividing the 
answer by ANGLE results in the number of steps this joint must be moved. 
The sign of this operation indicates what direction the movement should take. 

The easiest thing to do would probably be to move one of the joints the 
calculated number of steps, then move the other joint. Such an action would 
eventually place the end point at the destination, but it will move all over the 
place before it gets there. The solution is to move both joints at the same time. 
For example, if the calculations indicate the elbow should move 100 steps and 
the shoulder should move 200 steps, then we just move the elbow once and the 
shoulder twice, over and over until we get to the destination. 
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This is easy as long as everything involves nice round numbers like 100 
and 200. If the numbers were 67 and 92 then things are a little more compli- 
cated. Fortunately, there is an easy solution. It involves an algorithm de- 
veloped for machine tool control. It was discussed in a two part article by 
T. A. Seim in the March and April (1980) issues of Computer Design. I also 
found an excellent explanation of the algorithm in the MiniMover-S robot 
arm manual from Microbot Inc. 

The algorithm provides a step-by-step method for determining when to 
step each joint. Even though we only have two joints to worry about with this 
arm, the algorithm can handle an unlimited number of joints. For example 
purposes, let’s assume that we have three joints, J1, J2, and J3. Also assume 
that they are to be stepped 8, 5, and 2 times respectively. The algorithm first 
requires that we determine the largest number of steps of any joint. I will call 
this number WN, and, in this case, that number would be 8. We divide this 
number in half and use the result to initialize a counter for each joint. Our ex- 
ample now has three counters that are each set to 4. 

Next we perform the following operations N times (8 in this case). First, 
subtract the absolute value of the number of steps each joint is supposed to 
step from the associated counters. If the resultant number is positive, then 
continue with the loop. If the result is negative, then it is time to step the joint 
in question. The value for N should be added to the counter before the loop is 
continued. 

To help make this clear, the table below shows the calculations and 
counters for the three joints in our example. 


Loop Joint 1 Joint 2 Joint 3 

1 4-8= -4 4-S=-1 4-2= 2 
(step & add 8) (step & add 8) 

2 4-—8=-4 7-5= 2 2-2= 0 
(step & add 8) 

3 4-8=-4 2-—5= -3 0-2=-2 
(step & add 8) (step & add 8) (step & add 8) 

4 4-8= -4 5-5= 0 6-—2= 4 
(step & add 8) 

5 4—8= -4 0-5=-5 4-2= 2 
(step & add 8) (step & add 8) 

6 4-—8= -4 3-—-5=-2 2-2= 0 
(step & add 8) (step & add 8) 

7 4-8=-4 6-5= 1 0-—2= -2 
(step & add 8) (step & add 8) 

8 4-8= -4 1-S= -4 6—-2= 4 


(step & add 8) 


(step & add 8) 
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As you can see, each joint steps the appropriate number of counts. In ad- 
dition, and perhaps just as important, the steps occur at relatively equal inter- 
vals over the entire range. We now have enough knowledge to write a program 
to control the jointed simulator. The program is listed at the end of this 
chapter in Figure 7.4. If you have the optional diskette you can just LOAD 
INTEL.JOINTED. 


THE PROGRAM 


Actually, the program is very straightforward and easy to follow, especially 
with all the comments provided. The first section performs the necessary ini- 
tialization. The second section reads groups of three numbers from DATA 
statements. The first of these numbers becomes the value of PEN and deter- 
mines if the arm draws as it moves. The next two numbers are the X-Y coor- 
dinates of the point where the arm is to move. 

If you want the arm to draw a specific shape, all you need to dois makea 
DATA statement of the coordinates of the points in the order that they should 
be connected. An alternative woufd be to have the program calculate its own 
data. For example, an equation for a circle could be used to generate the 
necessary points. 

The next section uses the trigonometry discussed earlier to calculate the 
new angles B3 and B4. These, along with the present angles of the elbow and 
arm (RE, RA), are used to determine the number of steps each joint needs to 
take. These numbers are stored in an array as S(1) and S(2). The reason I used 
array variables here is not very obvious. As you recall, the algorithm discussed 
earlier works no matter how many joints are involved. Even though the pres- 
ent example uses only two joints, you may wish to add more for your own ex- 
periments. To help you out, my coding of the algorithm will work for as many 
joints as you wish. Just set NM equal to the number of joints in your arm, and 
fill the array with the number of steps for each joint. 

The next portion of the program causes the actual movement of the 
joints by setting the appropriate variables and making a call to the simulator 
subroutine. In a later chapter, we will modify this section so that it can control 
a real arm. For now though, let’s see what the simulator can do. 

Figure 7.3 shows sample drawings by the arm of a square. Each picture 
uses the DATA and ANGLE shown. It is easy to see that smaller step angles 
provide greater accuracy. You can also see that the arm does not move ina 
straight line between points. Therefore, if you wish the arm to follow a 
specific path, it is best to provide as many points as possible. 
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Figure 7.3 The simulator’s accuracy is effected by the step angle and the number 
of points used to define the object being drawn. 


SUGGESTIONS FOR FURTHER STUDY 2 


Try using DATA statements or equations to make the arm draw other shapes 
such as polygons or circles. Examine the effect that ANGLE has on your 
work. Later when we build a real arm, you can use this information to decide 
what its smallest step angle should be. 

As you perform these experiments, remember that rather than using this 
arm to draw, it could be moving a drill bit to a specific spot or a welding tip 
along a given path. Even if you never build a real arm, you can learn an enor- 
mous amount about robotics by controlling your own personal simulator. 


Suggestions for Further Study 


INTEL. JOINTED 


10 REM !---------------------- ! 
20 REM ! INTELLIGENT CONTROL ! 
30 REM |! OF A SIMULATED ! 
35 REM ! JOINTED ARM ! 


40 REM !USING "STEPPER" MOTORS! 
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30 REM ! COPYRIGHT 12/1/83 ! 
60 REM ! BY JOHN BLANKENSHIP ! 
70 REM ! ---------------------- ! 
80 REM 

90 REM !---------------------- ! 
92 REM ! MAIN INITIALIZATION ! 
94 REM !---------------------- ! 
93 HOME 

96 DR = 0: REM DRAW ARM 

100 DA =» 1: REM FLAG TO DRAW ARM 
105 ANGLE = .03 

110 R = 80: REM LENGTH OF ARM 
115 *8S = 100:YS =» 100 

120 RE w= 15 ® .01744:RA 2s 153 *® .01744 
125 Al =» RE:AZ = RA: REM STARTING ANGLES 
130 HGR VTAB (21) 

200 REM !-------------------- | 
20535 REM ! GET COORDINATES ! 
210 REM ! OF POINTS TO SBE ! 
215 REM ! DRAWN FROM DATA ! 
220 REM ! STATEMENTS ! 
225 REM ! LAST DATA = 0,0,0 t 
230 REM !-------9-9-2- 5-2 %"4%"""-°- ! 


235 READ PEN,NX,NY 

236 DATA 1,30,30,0,530,30,0,70,30,0,90,30,0,90,530,0, 
90,70,0,90,90 

237 DATA 0,70,90,0,30,90,0,30,90,0,30,70,0,30,50,0, 
30,30,0,0,0 

240 REM PEN DETERMINES PEN IS UP OR DOWN 

245 REM NX & NY ARE THE NEW COOR. 

230 IF PEN = 0 AND NX «= 0 AND NY = O THEN END 

2355 REM ! -----------2--""%-"%-°--- ! 

260 REM ! CALC. ANGLES ASSOC. ! 


265 REM ! ASSOC. WITH NX & NY! 

270 REM facesnc nsec ececinnnecs ' 

275 Bi = ATN (NY / NX) 

280 Si = SQR (NX * NX + NY *® NY) 
285 82 = S1 / 2 

290 83 = SQ@R ¢ ABS (R * R -—- 82 *® S2)) 
295 B2 = ATN (83 / 82) 

300 B3 = 3.1415 - Bi —- B2 

305 84 = R * SIN (B3) 

310 85 = R * COS (B3) 

315 87 = NX + 8S 

320 IF 84 = NY THEN B4 = 0: GOTO 335 
325 86 = NY - 84 

330 B4 = ATN (86 / 87) 

S55 REM leeseccenseecesteescsancues ‘ 
340 REM ! NOW THAT A3 AND A4 ARE |! 
345 REM ! THE NEW ANGLES ! 
350 REM ! FIND NUMBER OF STEPS ! 
355 REM ! NEEDED FOR EACH MOTOR |! 
5360 REM fe<ececsccccceeecsesnew nx ! 
365 8(1) = INT ((B4@ - RE) / ANGLE) 
370 RE = RE + S(1) * ANGLE 

375 8¢(2) = INT (¢€B3 - RA) / ANGLE) 
380 RA = RA + 8(2) * ANGLE 


Figure 7.4 INTEL.JOINTED 
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385 REM !----------------------- ! 

390 REM ! MOVE MOTORS # OF STEPS! 

395 REM ! IN 8¢1) AND 8(2) ! 

400 REM ! NOTE THIS IS A GENERAL! 

405 REM ! ROUTINE THAT CAN ! 

410 REM ! HANDLE NM MOTORS ! 

415 REM !---------+-------------- ! 

420 NM = 2 

425 REM FIND MAX 8() 

430 MS = ABS ¢(8¢1)): REM ASSUME 8¢(1) I8S THE MAX 
435 FOR I = 2 TO NM 

440 IF ABS (SCI)) > MS THEN MS = ABS (S¢1I1)) 
445 NEXT I 

430 REM SET COUNTERS TO HALF OF MAX 

455 FOR I =» 1 TO NM:CCI)D =» MS / 2: NEXT I 

460 REM !--------------------- ! 

9465 REM ! DETERMINE WHEN TO ! 

470 REM ! STEP EACH MOTOR ! 

475 REM ! ------------3-------- ! 

480 FOR I = 1 TO MS 

485 FOR J = 1 TO NM 

486 CCJ)D) =» CCID = ABS (8¢J)) 

490 IF C¢cJ)> ¢€ O THEN C(J) =» CC(J> + MS: GOSUB 1000 
495 NEXT J,I 

500 GOTO 200: REM GO BACK FOR NEXT POINT 

1000 REM !------+--------------- ! 


1005 REM ! STEP MOTOR J FORWARD! 
1010 REM !' OR BACKWARD, DEPEND-'! 
1015 REM ! ING ON +- OF SCJ) : 


1020 REM !--------------------- ! 

1025 REM DECIDE WHICH MOTOR TO STEP 
1030 ON J GOTO 1100,1200 

1040 RETURN 

1100 REM !---------------- ! 

1105 REM ! STEP MOTOR # 1 ! 

1110 REM !---------------- ! 

111353 ARM = SGN (S¢J)) 

1120 ELBOW = 0O 

1130 GOSUB 60000: REM MOVE SIMULATION 
1140 RETURN 

1200 REM !---------------- § 

1205 REM ! STEP MOTOR @ 2 #! 

1210 REM !---------------- ! 

1215 ELBOW = SGN ¢(S¢J)) 

1220 ARM = O 

1230 GOSUB 60000: REM MOVE SIMULATION 
1240 RETURN 

1300 REM !---------------- ! 

1305 REM ! ADD MOTORS HERE! 

1310 REM !---------------- ! 

60000 REM f—--—- - - — ne ne ee ae ee ee ! 


60010 REM ! JOINTED ARM VIDEO SIMULATOR $! 
60020 REM ! COPYRIGHT MAY 1982 BY ! 
60030 REM ! JOHN BLANKENSHIP ! 


600460: REM tae eeeee cee see eee eee ete ! 
60060 IF ELBOW = 1 THEN A1 = Ai + ANGLE: GOTO 60080 


60070 IF ELBOW = - 1 THEN Ai = A1 —- ANGLE 
60080 IF ARM = 1 THEN A2 = A2 + ANGLE: GOTO 60100 
60090 IF ARM = - 1 THEN AZ = AZ - ANGLE 


60100 IF Ai < O THEN A1 = 0 
60146, REM [eee ens e nce seen tee ceemeeesed ! 


60130 REM ! CALCULATE X-Y CO-ORDINATES ! 

60160 REM f—— — — = a ae we a a a ee ee ee ee ee ee ! 

60170 XE = x¥S - R *®% COs (‘A1):YE = YS - R * SIN (C(A1) 
60180 X =» XE + R ® COS (A2):Y¥ m= YE -—- R 28 SIN C¢A2Z) 


Figure 7.4 (cont.) 


60190 
60200 
60210 
60220 
60230 
60240 
602350 
60260 
60270 
60275 
60280 
60290 
60300 
60310 


60320 
60330 
60340 
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IF DR = 1 THEN 
HCOLOR= 0O 
HPLOT £8,Y8S TO x0,YO: 
HCOLOR= 1 

HPLOT *8,YS TO XE,YE: 
HCOLOR= 0 

HPLOT xO.YO TO &£L,YL 
HCOLORs 1 
HPLOT XE,YE TO 
HCOLOR= 3 
IF PEN = 


REM ERASE ELBOW 


REM DRAW NEW ELBOW 


x,Y¥: REM DRAW NEW UPPER ARM 


0 THEN HPLOT XL,YL TO X,.Y¥: REM DRAW 


LINE AS ARM MOVES 


REM -~-~--NOW RESET OLD POINTS---- 
XO = XE:YO =» YE:X~L = X€:YL =» ¥ 
RETURN 


Figure 7.4 (cont.) 
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Motors 


JUST WHAT WE NEED 


In the last two chapters, I have shown you how to create a simulation of a 
jointed arm on your video screen and how to write programs to control the 
movement of that arm. When writing the controlling program, it was assumed 
that each joint of the arm could be commanded to move forward or backward 
by the number of radians equal to the variable ANGLE. Wouldn’t it be nice if 
there was a motor that could perform such an action. Fortunately, there is. 

A stepper motor is capable of moving in small incremental steps each 
time it is told to do so. Before we get into controlling this motor with the com- 
puter, let’s look at how a stepper motor works. The following discussion is 
simplified, but I think that it will give you a quick general idea of how a four- 
phase stepper operates. 

Refer to Figure 8.1, which shows a portion of a donut-shaped piece of 
metal with a number of bars protruding toward the center. Each of these bars 
is given a label from | through 4. All of the bars labeled 1 can be magnetized 
by energizing the coils associated with them. A similar action can occur with 
the number 2, 3 and 4 bars. For clarity’s sake, Figure 8.1 only shows a coil for 
the bars labeled 1. For now, just make the assumption that a control circuit 
will be available that can energize any of the coils that we wish. 

In the center of this magnetizable donut, we will place a cylinder that is 
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Figure 8.1 Stepper motors use magnetic 
fields to align the rotor with one of four 
sets of stationary bars. 


free to rotate ona shaft. This cylinder, or rotor, will have protruding bars that 
line up with every fourth stationary bar. If one of the coils is energized, then 
the rotating bar will line up with the associated pair of protruding bars. If we 
apply a voltage to each coil in turn, then the cylinder will follow the rotation 
of the magnetic field. The table below shows the sequence of voltage that must 
be performed over and over in order to rotate the motor. A 1 means that 
voltage is applied to the coil, while a 0 means it is not. 


Coil # 1 2 3 4 
step 1 ] 0 0 0 
step 2 0 l 0 0 
step 3 0 0 ] 0 
step 4 0 0 0 ] 


step 5 Start Over 


STEP VARIATIONS 


If the steps are performed starting at the bottom and working up, then the 
rotation of the motor shaft will be reversed. Without changing anything but 
how voltages are applied to the coil, we can get the motor to move with half 
steps. Let’s see how this can be accomplished. If two adjacent coils are en- 
ergized at the same time, then the rotating bar will center between them. 
The following steps will move the bar with half-step increments. Just as 
before, reversing the order of the steps will reverse the motion of the motor 
shaft. 
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Coil # 


step 1 
step 2 
step 3 
step 4 
step 5 
step 6 
step 7 
step 8 


KCOOCOCOKH 
COCOKKHO 
COKFKeKHooco|ny 
Mee COOCCO 
OK WNAANOO 


Refer back to the figures, and convince yourself that this sequence will rotate 
the shaft in half-step increments. The numbers in the far right-hand column 
are the decimal equivalents of the binary numbers representing the coil 
voltages. Don’t worry about these numbers now. We will use them later in the 
chapter. 

Unlike the theoretical stepper motor I have been using for explanatory 
purposes, a real stepper motor generally will have many internal bars. This 
means that the step angle will be small. Some typical angles are 7.2 and 3.6 
degrees, although stepper motors may be purchased with larger angles, such 
as 90 degrees. 

Stepper motors come in a wide variety of types and styles. The motors 
discussed so far, for example, will probably have eight wires to control the 
four coils. Other configurations offer control with five or six wires (see Figure 
8.2). As we shall soon see, any of these configurations will be acceptable. 


aa lai 


8 WIRE 5 WIRE 6 WIRE 


Figure 8.2 The four windings in a typical stepper motor may have one of several 
configurations. 


INTERFACING 


Figure 8.3 shows how a motor can be interfaced to a computer. The signals 
from an output port are sent to four inverters, which act as buffers. These in- 
verters drive four transistors, which are used to energize each of the four 
motor coils. The size of the transistors depends on the current requirements of 
the motor used. If large currents are required, don’t hesitate to use darlington 
or VMOS transistors. 
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COMPUTER 
OUTPUT PORT 


Figure 8.3 An input port can be used to drive the windings of a stepper motor. 


Figure 8.4 shows the actual connections to a typical 8-wire stepper 
motor. Notice that two wires are crossed. In most publications, these wires are 
not crossed. Consequently, these publications have the two middle columns 
of their step tables reversed, if you compare them with mine. I prefer my 
tables because they make the operation of the stepper motor much easier to 
understand. 

Some motors require a Series resistance of a few ohms to limit the current 


Figure 8.4 Connect the transistors to 
the stepper motor as shown here. Note 
the crossing of two of the wires. 
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in each winding. In some cases, you might want to buffer the transistor inputs 
with a TTL gate and/or an optical isolator. Refer back to Chapter 4 for more 
details concerning interfacing. 

I should also point out that some stepper motors have a coil arrangement 
that requires both positive and negative supply voltages. Such motors are 
referred to as bipolar and tend to be harder to interface for the novice. All of 
my examples will use single supply or unipolar motors. 


PROGRAM CONTROL 


Once a motor has been interfaced to an input port as described, all that is left 
to do is write a program that can turn on the proper coils in the proper order. 
A program (Figure 8.6) that can perform these actions Is listed at the end of 
this chapter. The port used was a 6522 VIA, on a John Bell Engineering 
parallel interface card, at address $C181 (slot 1). The beginning of the pro- 
gram sets P equal to the address of the port and DD equal to the address of the 
data direction register in the VIA. Line 40 sets the data direction register to all 
1’s which makes each bit an output pin. 

The output port is cleared in line 41 to shut off all transistors. Because of 
the inverting buffers mentioned earlier, this port is cleared by sending it all 
1’s. If they are left all on or in a nondeterminant state for very long, the motor 
can overheat and possibly sustain damage. You might want to turn the motor 
power supply off until the program is running. 

Line 42 provides for the input of A$, which will be discussed later. Line 
45 restores a pointer so that READ statements start at the beginning of the 
DATA statement. The major loop (lines 50-65) reads the numbers from the 
DATA statement, subtracts them 255, and POKES them into the port. The 
subtraction operation is necessary because of the inverting buffers. Each time 
all the numbers have been used, line 70 starts everything over again. 

Line 51 generates a delay that is proportional to the number entered at 
line 42. The bigger the number, the slower the motor will rotate. Since BASIC 
is relatively slow, no delay is actually necessary. If you were to drive a stepper 
motor from assembly language, a delay would have to be inserted, or the 
motor would not be able to keep up with pulses from the program. Since the 
program cannot determine when or if the motor slips, then it is important to 
not step the motor faster than it can move with its present load. Experiment 
with the motors you plan to use to determine what delays, if any, are required. 

If you want the motor to reverse its rotation, just reenter line 100 with the 
numbers in reverse order. 
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INTEGRATED CIRCUIT CONTROLLERS 


There are several special integrated circuits available that can perform all the 
operations that we have been doing with software. An example of such a cir- 
cuit is the SAA1027 from Airpax. It interfaces a stepper motor to a computer 
using only two I/O lines as shown in Figure 8.5. One pin is used to control the 
direction that the motor will rotate. Every time the second pin is pulsed once, 
the motor will move one step in the designated direction. 

Controller IC’s have buffered outputs so that they can drive many small 
stepper motors without external transistors. The use of such chips can greatly 
simplify the application of stepper motors. Refer to the specification sheet of 
your choice of driver IC if you prefer to pursue this area further. 


SUGGESTIONS FOR FURTHER STUDY 


After you have the motor moving as described above, you may want to try 
your hand at writing a program to test your understanding before moving on 
to the next chapter. Place a pointer on the shaft of the motor and write a pro- 


STEPPER 
MOTOR 


STEP 


DIRECTION 


Figure 8.5 Driver IC’s can simplify the interfacing and control of stepper motors. 
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gram to determine or confirm its step angle. Write another program to make 
the motor perform a series of actions such as the ones listed below. 


. Make one revolution clockwise slowly. 

. Make 2 fast revolutions counterclockwise. 
. Pause 3 seconds. 

-» Make 1 very slow clockwise revolution. 

. Stop. 


n& Ww NHN —_ 


When you feel comfortable with the fundamentals of stepper motor con- 
trol, move on to the next chapter, and find out how to modify the simulator 
control program developed in Chapter 7 so that it can control a real arm with 
real stepper motors. 


10 REM PORT=$Ci81 DD=C183 

20 P = 4096 *® 12 + 256 + 8 * 16 + 1 
30 DD = P + 2 

40 POKE DD.255 

41 POKE P,255 

42 INPUT A&% 

45 RESTORE 

50 FOR I = 1 TO 8 

Si FOR J = 1 TO VAL (A$) * 10: NEXT J 
25 READ A 

60 POKE P.¢€15 - A> *® 16 

65 NEXT I 

70 GOTO 45 

100 DATA 9,1,3,2,6,4,12,8 


Figure 8.6 Sample program to control the stepper motor. 


Cuilding 
9 Jointed Arm 


FLEXIBILITY 


In this chapter, I want to show you how to build a jointed arm. This arm, like 
the others so far, will only be used to verify the theoretical principles discussed 
in other chapters. Because of that, the arm will not need to be strong, or even 
especially reliable. Since we may want to try several different types of ex- 
periments, we will want the design of the arm to be as flexible as possible. In 
particular, I wanted the arm to operate as close as possible to the simulation 
described in Chapter 7, but our needs don’t stop there. 

In addition to the stepper motors discussed in the last chapter, I will be 
examining the control of standard DC motors in Chapter 11. When you read 
Chapter 11, you might want to apply this knowledge and build a jointed arm 
that uses DC motors or even a combination of stepper and DC motors. There- 
fore, we need a jointed-arm design that can serve as the mechanical system for 
any or all of these experiments. After digging through my junk boxes and 
visiting the local hardware and hobby stores, I came up with the design shown 
in Figure 9.1. Figure 9.2 shows a picture of the finished arm. Refer to both of 
these figures as you read the following discussion. 
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Figure 9.2 This balsa wood arm can 
draw when a pen is inserted into its 
hand. 


CONSTRUCTION 


There are two brass tubes (A and B) protruding through the TOP of the arm. 
Turning these tubes will move the elbow and shoulder joints. As we shall see, I 
have made extensive use of brass tubing. Any well-stocked hobby store should 
have a good selection of brass tubes. The outside and inside diameters are such 
that adjacent sizes will fit smoothly inside of each other. Tube A for example, 
runs through a larger tube in the TOP, which acts as a bearing. The bottom 
end of tube A was pinched together with a pair of pliers so that it would fit 
into the slotted shaft of a 1SOK potentiometer. The potentiometer can be used 
to control DC motors and will be discussed in a later chapter. 

A small gear is glued to the shaft of the potentiometer. This gear turns 
another gear that is glued to another brass tube (B) that uses two other larger 
tubes as bearings. When this tube is turned, it rotates a pulley that turns a sec- 
ond pulley connected to tube D. This tube rotates freely inside three larger 
tubes that also act as bearings in order to turn an upper pulley. This action ro- 
tates tube E, which moves the forearm. Note that this action will have no ef- 
fect on the upper arm. 

Tube B rotates a second potentiometer just like the action of tube A. A 
gear transfers this motion to a second gear, which 1s glued to a brass tube, 
which is glued to the upper arm. It is important to drill all the holes for the 
‘‘bearing’’ tubes as perpendicular as possible to eliminate binding. I used 
epoxy to glue everything together, but most any good adhesive should work 
equally well. 

The actual arm segments were made from balsa wood to keep the weight 
as low as possible. I used pine for the remainder of the wooden parts, primar- 
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ily because it is cheaper than balsa. One of my pulley assemblies is actually a 
chain drive from an old erector set. Use your imagination a little, and you can 
build your arm very inexpensively. 


ATTACHING MOTORS 


The next step is to connect appropriate motors to shafts A and B. Refer to 
Figure 9.3 to see how | handled this. My stepper motors had a small gear at- 
tached to their output shaft. I found some larger gears with matching teeth 
and had planned to glue them to the brass tubes. It turned out that the tubes I 
used were much smaller than the holes in the gears. I placed a short piece of 
rubber tubing over the brass tubes and then forced the gear over that. Sucha 
connection works extremely well. After you attach your motors, determine 
the angle each joint moves for each motor step. 

I then mounted the stepper motors so that they could drive the gears, and 
my arm was pretty well complete except for connecting the motors to the com- 
puter. I used the drive circuitry discussed in Chapter 8. Figure 9.4 shows an 
easy method for constructing the interface. I mounted a prototyping board on 
the arm itself. The circuit can be quickly built and modified without any 
soldering. 


Figure 9.3 Gears are used to decrease the effective step angle while increasing the 
torque. 
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Figure 9.4 The interface circuit was 
constructed on a proto-board and 
mounted directly on the arm. 


THE SOFTWARE 


We can control this real arm with the same program that was used to control 
the video simulation in Chapter 7. To do so, we must replace the simulation 
subroutine with a set of modules that can physically move the motors. A 
listing of such a program is given in Figure 9.5 and on the optional diskette 
under the name STEP.MOTOR.ARM. This program still draws the simula- 
tion, which moves in sync with the real arm. If you do not want the simula- 
tion, just replace lines 60000 through 60340 with the following line. 


60000 RETURN 


Except for a few initialization differences, the only changes in this pro- 
gram are in the modules that actually step the motors. For example, look at 
lines 1125 through 1146. These lines move the elbow motor one step forward 
or backward depending on the value of ELBOW. Let’s see how this action is 
accomplished. 

First, you need to know that the array ST was initialized to the eight 
numbers that will move the motors in half-step increments (See lines 130, 
145). The program needs only to fetch the appropriate numbers from the 
array and POKE them into the output port. The direction of the motor will be 
different depending on whether we increment or decrement through the array 
elements. The variable C1 is used to keep track of where the routine for motor 
1 is presently fetching. 

Since ELBOW is either —1 or + 1 depending on the desired direction, 
line 1130 calculates a new C1. As C1 is incremented and decremented, lines 
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STEP .MOTOR . ARM 


REM !----2-2%e%%5%5%%°%°°°"°°°--- ! 
REM | INTELLIGENT CONTROL } 
REM |! OF A STEPPER ! 
REM |! MOTOR ARM ! 
REM ! COPYRIGHT 12/1/83 ! 
REM ! BY JOHN BLANKENSHIP |! 
REM | -----------------°----- ! 
REM 

REM | ------- 92-29-22" ------ ! 
REM ! MAIN INITIALIZATION ‘! 
REM ! ---------------------- ! 
HOME 

DA = 1: REM FLAG TO DRAW ARM 


P 


= 4096 * 12 4+ 2536 + 8 * 16 + 1 


DD = P + 2 


Ci m» 4:C2 aw 4 

ANGLE =» .02372: REM SET BASED ON YOUR GEAR RATIO 
8 

R =» 80: REM LENGTH OF ARM 


x 
R 
A 


POKE DD,235 


8 =» 100:¥YS = 1850 
Ew 0©0:RA x2» 3.14 / 2 
1 m=» RA:A2 = RE 

FOR I 28 1 TO 8 

READ ST CI) 


ST¢CI) # 1353 - STCI) 

NEXT I 

DATA 8,12,4,6,2,3,1,8 

HGR : VTAB (21) 

REM ! ------------2------- t 
REM |! GET COORDINATES ! 
REM |! OF POINTS TO SE ! 
REM ! DRAWN FROM DATA ! 
REM |! STATEMENTS ! 
REM ! LAST DATA = 0O,0,0 ! 
REM !------------"e%"e%-°-°-°--°- ! 


READ PEN,NX ,NY 


DATA 1,30,30,0,530,30,0,70,30,0,90,30,0,90,50,0, 


90,70,0,90,90 


DATA 0,70,90,0,30,90,0,30,90,0,30,70,0,30,50,0, 


30,30,0,0,0 

REM PEN DETERMINES PEN IS UP OR DOWN 
REM NZX & NY ARE THE NEW COOR. 

IF PEN = 0 AND NX = 0 AND NY = O THEN 
REM |-------------------- ! 


REM ! CALC. ANGLES ASSOC. ! 

REM ! ASSOC. WITH NX & NY! 

a ee ee ee ee ' 

Bi =. ATN (NY / NZX) 
881i =» BSBQR (NX ® NX + NY ® NY) 

82 = Si / 2 
83 = SQR ( ABS (R * R - 82 *® 82)) 
B2 = ATN (83 / 82) 
B3 = 3.1415 -—- Bi — B2 

84 = R * SIN (B3) 
85 = R * COS (B3) 

87 = NX + 85 

IF S84 = NY THEN B4@ = 0: GOTO 335 
86 = NY - 84 
B4 = ATN (86 / 87) 


Figure 9.5 STEP.MOTOR.ARM 


END 
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335 
340 
345 
350 
355 
360 
365 
370 
375 
380 
385 
390 
395 
400 
405 
410 
415 
420 
425 
430 
435 
440 
445 
450 
455 
460 
465 
470 
475 
480 
485 
486 
490 
495 
500 
1000 
1005 
1010 
1015 
1020 
1025 
1030 
1040 
1100 
1105 
1110 
1115 
1120 
1125 
1130 
1135 
1140 
1145 
1146 
1150 
1200 
1205 
1210 
1215 
1220 
1225 
1230 
1235 


REM [------------------------ ! 
REM ! NOW THAT A3 AND A@4@ ARE §! 
REM ! THE NEW ANGLES i] 
REM ! FIND NUMBER OF STEPS ! 
REM ! NEEDED FOR EACH MOTOR #§! 
REM !------------------------ t 
8§¢(1) = INT (¢€B@ - RE) / ANGLE) 
RE = RE + 8(1) ® ANGLE 
8¢(2) s INT (€(B3 - RA) / ANGLE) 
RA = RA + S$¢€2)> *® ANGLE 
REM /!-----------------+-------+ ! 
REM ! MOVE MOTORS @ OF STEPS! 
REM ! IN 8(1) AND S$(2) ! 
REM ! NOTE THIS IS A GENERAL! 
REM ! ROUTINE THAT CAN ! 
REM ! HANDLE NM, MOTORS ! 
REM !----------------+-------- ! 
NM = 2 
REM FIND MAX S8() 
MS = ABS (8¢1)): REM ASSUME 8(1) I18S THE MAX 
FOR I = 2 TO NM 
IF ABS (S¢1I)) > MS THEN MS = ABS (S3¢1)) 
NEXT I 
REM SET COUNTERS TO HALF OF MAX 
FOR I = 1 TO NM:CCI)> =» MS / 2: NEXT I 
REM !----—----—--------------=- ! 
REM ! DETERMINE WHEN TO ! 
REM ! STEP EACH MOTOR ! 
REM !--------------------- ! 
FOR I = 1 TO MS 
FOR J = 1 TO NM 
C(J> =» CCID =- ABS (S¢J)») 
IF C¢cJ) ¢€ O THEN CC(J) =» CCJ>? + MS: GOSUB 1000 


NEXT J,I 
GOTO 200: REM GO BACK FOR NEXT POINT 


REM (oeeeseeeseteeseeeetes ‘ 
REM ! STEP MOTOR J FORWARD! 
REM ! OR BACKWARD, DEPEND-! 
REM ! ING ON +¢- OF S(J) 
REM (a+e-2eseeeee se eseeses ! 
REM DECIDE WHICH MOTOR TO STEP 
ON J GOTO 1100,1200 
RETURN 
REM tececee cesses eees ' 

REM ! STEP MOTOR # 1 ! 
REM leone seneeeseeens ' 
ARM = SGN (8¢J)) 


ELBOW = 0 
FOR Z = 1 TO 12 
Ci = C1 — ELBOW 

IF C1 = 0 THEN C1 = 8 

IF Ci = 9 THEN C1 = 1 

POKE P,ST(CZ) * 16 + ST(C1) 
NEXT Z: GOSUB 60000 

RETURN 

REM (<e4eseessesueees ' 

REM ! STEP MOTOR @ 2 ! 

REM. 1-2-4222 eee2e845 ' 


ELBOW = SGN (S¢(J)) 


ARM 


FOR Z 2 1 TO 12 


Cz 
IF 


=s C2 + ARM 
C2 zs O THEN C2 s 8 


Figure 9.5 (cont.) 
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IF C2 #2 9 THEN C2 = 1 

POKE P,ST(C2) *® 16 # ST(C1) 

NEXT Z: GOSUB 60000 

RETURN 

REM !------<<---2+-+--+-- ! 

REM ! ADD MOTORS HERE! 

REM !--------+-+-+------ ' 

REM J—----------- - — ~~ ~~ - - - ! 
REM ! JOINTED ARM VIDEO SIMULATOR |! 
REM | COPYRIGHT MAY 1982 BY ! 
REM ! JOHN BLANKENSHIP ! 
REM Pee ee ee ee ee a ee ae en ee eee ee ee ee i] 
IF ELBOW = 1 THEN Ai1 » Ai + ANGLE: GOTO 60080 
IF ELBOW = - 1 THEN Ai s Ail —- ANGLE 


IF ARM = 1 THEN AZ = AZ + ANGLE: GOTO 60100 
IF ARM = - 1 THEN A2 = A2 - ANGLE 

REM 

oy nn ee ee ’ 

REM |! CALCULATE X-¥ CO-ORDINATES ! 

ol, ee f 
XE = XS - R * COS (A1):YE = ¥S8 - R *® SIN (¢A1) 
X = XE + R * COS (A2):¥ = YE —- R ®~ SIN (A2) 
REM {oe eee tee eee tee eee ! 

REM ! REDRAW AND PLOT POINTS |! 

2 a ee ! 

HCOLOR= 0 

HPLOT xS,¥S TO xO0,YO: REM ERASE ELBOW 

HCOLOR= 1 

HPLOT xS,YS TO XE,YE: REM DRAW NEW ELBOW 
HCOLOR= 0 

HPLOT xO,YO TO XL,YL 


HCOLOR=.s» 1 

HPLOT XE,YE TO X,Y: 
HCOLOR=s 3 

IF PEN = 0 THEN 
LINE AS ARM MOVES 


REM DRAW NEW UPPER ARM 


HPLOT XL,YL TO X,Y: REM DRAW 


REM ----NOW RESET OLD POINTS---- 
XO = XE:YO =» YE:XL = X€:Y¥YL = Y¥ 
RETURN 


Figure 9.5 (cont.) 


1135 and 1140 ensure that whenever the ends of the array are reached that the 
fetching starts over at the first or last element of the array, as appropriate. 


CONTROLLING THE MOTOR 


Line 1145 is responsible for sending the actual data to the port. Since both 
motors are connected to the same port, we must always send two sets of data 
at a time (one for each motor), even if one set has not been changed. Just as 
C1 keeps track of the array position for motor 1, C2 keeps track of the array 
position for motor 2. Motor 2 is connected to the four most significant bits of 
the port, while motor 1 is connected to the four least significant bits. Line 
1145 POKES the port with the proper number for motor 1 plus sixteen times 
the number for motor 2. Multiplying by sixteen effectively shifts a binary 
number four places to the left, thus making it use the most significant bits. 
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An almost identical series of actions takes place in the module that steps 
motor 2. The program provided draws the same square as the simulation of 
Chapter 7. Figure 9.2 shows this square as it was drawn by the real arm. Notice 
that it is distorted, especially at the corners. At first you might expect that the 
distortion was due to a large step ANGLE. This, unfortunately, is not the 
case. Because of the gearing of the motors I used, the angle moved for each 
step was very small. 

The distortion was due to give or stretch in the belt and chain used to drive 
the elbow joint. Once the arm is moving in a given direction (and the belts are 
tight), each step of the motor moves the arm the expected amount. When 
the elbow joint is reversed in its direction, though, many steps are required 
just to take up slack in the belts. This inability to respond immediately, causes 
distortion whenever directions are changed, such as the corners of the square. 

This is a very important lesson. Even if we can precisely position our 
drive motors, our arms are still subject to errors due to gear backlash, belts 
stretching, and any other imperfections in our construction. This will have to 
be Kept in mind when the man-sized arm is designed. 

By now, you should understand how easy it is to position a stepper motor 
arm using your computer. In the next chapter, I will show you how to imple- 
ment similar control over plain old everyday DC motors. 


Bositionsal 


Control 
of 0 Motors 


WHY DC MOTORS? 


In the last two chapters, I have discussed the positioning of an arm joint that 
was moved by a stepper motor. Stepper motors seem ideal for such a job, but 
they do have certain disadvantages. Their biggest drawback, in my opinion, is 
their lack of power. A standard DC motor will have many times the torque 
and speed as a stepper motor consuming the same amount of energy. What I 
want to show you in this chapter is how a DC motor can be used to control the 
stepper motor arm previously studied. 

As you may recall, I used DC motors for the X- Y arm in Chapter 4. At 
that time, I stipulated that the motors had to move the hand or pen at a rela- 
tively slow rate. To be precise, the arm had to move slow enough so that it 
would stop as soon as the motors were turned off. When a motor continues 
past its destination, it is said to overshoot. Figure 10.1 can help to clarify this 
idea. 

Part A of the figure shows the ideal movement of a joint over time. The 
top line indicates where the arm is, and the bottom line represents the desired 
position. Notice that the top line moves smoothly downward until it matches 
the bottom line. The only way this action could be improved is to make the 
joint reach the destination faster. Part B of Figure 10.1 shows what will hap- 
pen if we speed up the motor driving the joint. The joint approaches the 
destination much faster. So fast, in fact, that it cannot stop when it reaches 
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A Test Platform 103 


STARTING POINT 


DESTINATION 


(b) (c) 


Figure 10.1 A This graph shows the movement of a joint from its starting posi- 
tion to its destination. B If the joint moves faster it can coast past its destination. 
C Increasing the speed even further can cause the joint to oscillate around its in- 
tended resting point. 


the destination. After it overshoots, it must reverse and approach the line 
from the bottom. 

If the speed is increased even further, the action in Part C of the figure 
might result. In this case, even after the first overshoot, the speed is still so 
great that another overshoot occurs on the way up. After several overshoots, 
the destination is reached. If the speed is increased even further, these oscilla- 
tions might never die out and the joint would vibrate around its intended posi- 
tion. Our goal is to obtain a high speed without the overshoot problems. 


A TEST PLATFORM 


In order to reach our goal, we need to build a test platform that will allow 
us to demonstrate the techniques as they are developed. Figures 10.2 and 10.3 
show such a test platform. A piece of cardboard was cut slightly larger thana 
half circle and labeled with markings every five degrees. Two 150K poten- 
tiometers are mounted in front of the cardboard. The one closest to the card- 
board is connected by means of a piece of rubber tubing to a motor behind the 
cardboard. 

The other potentiometer shaft will be turned manually. Both shafts have 
pointers attached so that you can read the positions on the scale. These poten- 
tiometers will be connected to Apple paddle ports so that a program can know 
their positions. This program will read the value of the outside potentiometer 
and then turn the motor on (in the desired direction, of course) until the inside 
potentiometer matches. In order to reach our goal, it will also be necessary for 
the computer to be able to control the speed of the motor. 
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Figure 10.2 A cardboard protractor allows easy angular measurements of two 
pointers, which are attached to potentiometers. 


Figure 10.3 The motor is connected to the rear potentiometer using a piece of rub- 
ber tubing. The computer interface is built on a proto-board. 
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THE COMPUTER INTERFACE 


Figure 10.4 shows the circuits and connections necessary to interface a motor 
to the Apple game connector. Transistor Q1 is used to reverse the power con- 
nections to the motor while Q2 determines if the motor is on or off. A 555 
timer oscillates so that it produces a 1 about 33% of the time and a 0 approx- 
imately 67% of time. If the NAND gate labeled A is turned ON, then the 33% 
signal will be sent to Q2 and the motor will move at a slow rate. 

If the NAND gate labeled B is enabled, the inverse of the 555’s signal will 
be sent to the transistor. Since G2 now will be on approximately 67% of the 
time, the motor will turn at a medium speed. If both NAND gates are enabled, 
then Q2 will remain on all of the time and the motor will operate at its max- 
imum speed. Optical isolators were used to connect the annunciator outputs 
on the game connector to the motor control circuit. 

The motor I used was taken from a grill rotisserie and was meant to be 
powered by a 1.5 volt battery. Since my circuitry delivers 5 volt pulses, the 
motor can move relatively quickly. At the fastest speed, the pointer travels 180 
degrees in about 1 second. Whatever motor and voltages you finally use, you 
should be able to produce a similar speed in order to obtain the best results. 
Choose any NPN transistors that can handle the current requirements of the 
motor and relay you use. If your medium and slow speeds need some ad- 
justing, try slightly different values for the resistors in the 555 circuit. 


DESIGNING THE PROGRAM 


Now that we have the hardware and the interface to allow a computer to con- 
trola DC motor let’s examine the requirements of a program that can perform 
that control. Figure 10.5 shows a flowchart that can aid our understanding. 
After the appropriate initialization, the computer will read the paddles to 
determine the position of each potentiometer. If the two positions are equal, 
or at least as close as we wish to call equal, then the motor is turned off. 

If the difference in the two positions is great enough, then, depending on 
the sign of this difference, the relay will be turned on or off in order to estab- 
lish the proper direction of the motor. Next the motor is turned on. This por- 
tion of the program will be varied for our experiments so that we can see the 
effects of different motor speeds. Finally, my program will plot the values of 
the two potentiometers on the HIRES screens so that it will be easy to trace the 
movements. 
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Figure 10.4 The Apple game connector handles all the signals necessary to control the 
speed and position of a DC motor. 
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INITIALIZATION 
READ PADDLES 


TURN 
MOTOR OFF 


THEN 


IF 
PDL (0) 
<PDL (2) 


FOR 


SET RELAY 
FORWARD 


SET RELAY 
FOR 
REVERSE 


TURN 
MOTOR ON 


CODING THE PROGRAM 


Figure 10.5 This flowchart shows the 
actions required to position a DC mo- 
tor. Several different TURN MOTOR 
ON modules will be used to show the ef- 
fects of motor speed. 


A program that implements this flowchart can be found in Figure 10.6 and on 
the optional diskette as POS.CONTROL. Refer to it for the following discus- 
sion. Line 7 directs control to the main program, which resides at the end of 
the listing. I will discuss it ina moment. Let’s first look at the subroutines that 
will be used by the main program. 

Lines 9 through 16 make up the initialization module. The variables N1, 
N2, and N3 are set to the addresses that will turn on the game connector an- 
nunciators 1, 2, and 3. Similarly, F1 through F3 will turn off the annun- 
Ciatiors. The variable J is used when plotting the points on the HIRES screen 
and must be set to 0 so that the plots will begin at the top. 
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POS . CONTROL 


1 REM 1! --------------2e%ee%"°%°°°-"-- ! 
2 REM ! MOTOR POSITIONAL CTL ! 
3 REM ! SYSTEM ! 
4 REM ! COPYRIGHT MARCH 1983 |! 
5S REM ! BY JOHN BLANKENSHIP ! 
6 REM ! ---------------- 22%" "--- ! 
7 GOTO 1000 

8 REM 


9 REM INITIALIZATION 
10 Ni =» 49241:Fi 2 49240 
11 N2 = 49243:F2Z = 49242 
12 N3 =» 49245:F3 =» 49244 
13 I = O 


14 HGR : HCOLOR= 7 
is VTAB 22: RETURN 
16 REM 


100 REM ON FAST 
105 POKE N2,0: POKE N3,0: RETURN 
110 REM 


z200 REM ON MEDIUM 
205 POKE N2,0: POKE F3,0: RETURN 
210 REM 


300 REM ON SLOW 
305 POKE F2,0: POKE N3,0: RETURN 
310 REM 


400 REM OFF 
4905 POKE F2,0: POKE F3,0: RETURN 
410 REM 


300 REM REVERSE 
305 POKE F1,0: RETURN 
310 REM 


600 REM FORWARD 
605 POKE N1,0: RETURN 
610 REM 


700 REM SET SPEED 

703 xX =» ABS ‘A - 8B) 

710 IF X¥ >» 73 THEN GOSUB 100: RETURN 
720 IF X¥ >» 30 THEN GOSUB 200: RETURN 
730 GOSUB 300: RETURN 

740 REM 


1000 REM MAIN PROGRAM STARTS HERE 

1010 GOSUB 10 

1020 A = PDL (0):B = PDL (2) 

1025 PRINT A,B 

1030 IF ABS («A - B)? < 6 THEN GOSUB 400: GOTO 1020 

1040 IF A < B THEN GOSUB $00: GOTO 1060 

10350 GOSUB 600 

1060 GOSUB 700 

1070 I = I + 1: HPLOT A,I: HPLOT B,I: IF I ws» 160 THEN 
I = O 

1080 GOTO 1020 


Figure 10.6 POS.CONTROL 
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At line 100 is a subroutine that will turn the motor on at it fastest speed. 
This is accomplished by turning on annunciators 2 and 3 in line 105. Different 
combinations of ON and OFF for these two annunciators are used to produce 
the MEDIUM, SLOW, and OFF subroutines at lines 200, 300, and 400. An- 
nunciator | is controlled in the next two subroutines to set the FORWARD/ 
REVERSE state of the relay. The final subroutine at 700 will not be discussed 
just yet. Please ignore it for now, and move on to the main program at line 
1000. 

The main program should be very easy to understand. !t follows the 
flowchart in Figure 10.5 very closely. Line 1030 allows for a match if the 
potentiometer readings are within 5 of each other. Depending on the speed of 
your motors and the accuracy of your potentiometers, you may need to adjust 
this range. 

In the listing, line 1060 is GOSUB 300, which will turn the motor on at its 
slowest rate. Figure 10.7 is a HIRES screen dump obtained when the program 
was run. The upper line traces the potentiometer that was moved by me from 
about 20 degrees to about 160 degrees. The bottom line shows how the motor 
moved the other potentiometer until it matched the first one. Notice that this 
corresponds to Figure 10.1A. 

If we change line 1060 to read GOSUB 200, then the motor will move at a 
medium speed. Figure 10.8 shows the resulting plot for this speed. Notice the 
small overshoot that occurred. If line 1060 is changed to GOSUB 100 then the 
maximum speed will produce the plot of Figure 10.9. In this case, the speed 
was so fast that the oscillations never stop on their own. 

Now it’s time to look at the subroutine at 700 that was skipped earlier. It 
sets the speed depending on how large the difference is between the two poten- 
tiometers. If the difference is large, then the motor moves very fast. As it gets 
closer, the speed is reduced to medium and then to slow. Figure 10.10 shows 


Figure 10.7 This program plot was obtained when the motor was running at its 
slowest speed. 
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Figure 10.8 When the motor runs at medium speed, an overshoot occurs. 
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Figure 10.9 At its fastest speed, the motor oscillates continuously around its de- 
sired destination. 


Figure 10.10 When the computer varies the speed based on the distance left to 
travel, the tracking ability improves without causing overshoot. 
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Figure 10.11 This plot shows the tracking ability of the system. The upper line 
represents the manual pointer. 


how this affects the motion. The motor moves very quickly, but yet no over- 
shoot occurs. Figure 10.11 shows this ability to track as the manual poten- 
tiometer is moved several times. 


PHYSICAL IMPERFECTIONS 


If you build the test platform, and I strongly suggest you do, you will probably 
find that the two pointers are not nearly as accurate as the plots. The reason 
for this is that the two potentiometers do not give exactly the same readings at 
the same angles. I moved each of the potentiometers through 180 degrees in 5 
degree increments and recorded the paddle readings. The graph in Figure 
10.12 shows these readings. It is very obvious why the pointers don’t track ex- 
actly. This is very easy to fix. 

First, you need to record where your graphs cross. In my case, that point 
was 80. Next pick representative points on the graphs as indicated in Figure 
10.12. Record the distances of these points from the crossing point and from 
each other. Refer to the figure to see which distances I mean. In my case, the 
readings were 32 and 51. With this data, you can mathematically force the 
reading of one potentiometer to match the other. For my readings I needed to 
add the following line. 


1022 A =A + (A — 80)#(32/ 51) 
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PDL READINGS 


15 45 75 105 135 
ANGULAR POSITION 
(DEGREES) 


Figure 10.12 A graph of the potentiometer readings vs. the actual pointer positions 
not only shows potential problems but gives us the solution. 


When you add this line to your program, just substitute your readings for the 
numbers 80, 32, and 51. With this line added, the two pointers on my test plat- 
form stayed within % inch of each other. The program for this chapter is very 
short, and the test platform is easy to build. The results are very exciting, and 
there are many additional experiments that can be done in this area. 


SUGGESTIONS FOR FURTHER STUDY 


In my program, I controlled the motor speed based on how far apart the two 
pointers were. Even better results can be obtained if we keep track of not only 
the present position of the pointers, but of the last position or even the last two 
positions for each. Comparing these readings can give velocity and/or ac- 
celeration data which can be used along with the distance readings to influence 
the speed. If you decide to try your hand with such improvements, you might 
want to provide for a greater number of speed variations. 
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You might also want to try controlling several DC motors and stepper 
motors at the same time. In Chapter 7, we examined an algorithm for moving 
stepper motors in tandem. Each time the computer went through the loop it 
stepped only the appropriate motors so that they all arrived at their destina- 
tions at the same time. Consider putting a module inside the loop that reads 
the present position of each DC motor, and determines if it is presently ahead 
of or behind schedule compared to the stepper motors. Those that are moving 
too fast can be slowed down, and those moving too slow can be sped up. I 
have just begun experimenting in this area, and the results are quite gratifying. 

Another suggestion for experimentation in this area is to modify the arm 
of Chapter 9 so that it is powered by DC motors. Potentiometers were in- 
cluded in the original design to provide the necessary feedback information. 
Write a program to draw a square just as we did with the stepper motors. 


hobby Servo 1 
Motors 


COMPLETELY SELF-CONTAINED 


In the last chapter, I showed you how a computer could read a potentiometer 
and translate its value into positional information. The proper software and 
motor interface allowed us to control a DC motor easily and precisely. This 
combination of motor, potentiometer, and control is often referred to as a 
servo. 

Many computer hobbyists would prefer to spend their time writing soft- 
ware rather than tinkering with mechanical assemblies. For those persons, I 
have the perfect solution. It just so happens that relatively inexpensive, com- 
pletely self-contained servo systems are available at most hobby stores. These 
hobby servos are typically used in radio-controlled models such as airplanes 
and boats. 

Figure 11.1 shows what a typical servo looks like internally. The servo 
contains a motor and geartrain connected to a potentiometer. This poten- 
tiometer controls the width of the pulses generated by a built-in monostable 
multivibrator. The internal pulses are approximately 1 millisecond long and 
are the basis for controlling the system. 

A typical hobby servo has three wires. These usually are red and black 
for the power connections and some other color for the control signal. When- 
ever pulses are sent to this control wire, the internal monostable is triggered, 
and it generates a pulse. A special circuit compares this internal pulse to the 
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CONTROL 
PULSE 


Figure 11.1 This simplified drawing 
shows the principle of operation of a 
typical hobby servo. 


control pulse. If the internal pulse is longer than the external one, then the 
motor is turned on. If the control pulse is longer, the motor is also turned on, 
but in reverse. 

Whenever the two pulses are equal, the motor remains off. Remember, 
the length of the internal pulse is governed by the potentiometer, which is con- 
nected to the motor. This means that the length of the pulses that we send to 
the servo will determine the servo’s position. If the pulse sent does not equal 
the internal pulse, then the motor will turn in the proper direction until the 
pulses are equal. This action is very much like the control studied in Chapter 
10 except that the servo does all the work for us. 


GENERATING THE PULSES 


My next goal is to show you how to easily control a servo using a computer. 
The computer must not only generate a pulse of the proper length, but it must 
continue to do so 40 to 60 times each second. Any rate less than this would re- 
sult in a jerky movement. When I decided to write a program to generate these 
pulses, I had several objectives in mind. These objectives were as follows. 


1. The program should run in the background. (That is, its operation 
should be transparent to the user.) 

2. BASIC should be able to easily control the pulse width generated. (This 
would allow the user to write entirely in BASIC.) 
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3. The hardware requirements should be kept to a minimum. 
4. The program should be able to control several servos simultaneously. 


With these objectives in mind, I chose to interface four servos to the 
computer using only a cable from the Apple game port. I limited the number 
to four because there are only four annunciator (output) pins on the game 
connector. The program itself has to be written in machine language because 
of the speed requirements. BASIC will only need to POKE the four values 
that represent the four pulse widths into four specified locations. 

Each time the machine language program runs, it will read the four loca- 
tions and send one pulse of the proper length to each servo. We need some 
means to cause the program to run automatically about 60 times each second. 
The circuit in Figure 11.2 will generate a very short interrupt pulse for the Ap- 
ple’s 6502 processor at a 60 hz rate. The pulse must be short because I am us- 
ing the IRQ interrupt which is level-(not edge) triggered. The reason I chose 
the IRQ over the NMI interrupt is that the IRQ interrupt can be ignored under 
software control. This circuit can be built on an Apple prototype card and in- 
stalled in any convenient slot. Since RESET disables IRQ interrupts, you 
won’t even know the card is there until the proper software is run. 

The actual connection to the servos is very easy. Figure 11.3 details these 
connections in case you are not familiar with the Apple game connector. 


THE INTERRUPT PROGRAM 


Figure 11.4 is a listing entitled QUAD.SERVO.DRIVER. You may enter it in 
your machine if you do not have the optional diskette. The first part of the 


10K 


Figure 11.2 This single integrated cir- 
APPLE BUS cuit provides a 60 hertz interrupt signal. 


APPLE GAME CONNECTOR 
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SERVOS 


EXTERNAL 5 VOLT SUPPLY . 
Figure 11.3 Four hobby servos may be 


driven from the Apple game connector. 


program sets up the IRQ vector address so that this program will be run each 
time an interrupt occurs. The CLI instruction enables interrupts. 

At the label BASE, I placed four NOP instructions that act only as place 
holders. These are the four locations that BASIC must POKE the positional 
values for each servo. A fifth NOP at CNT is a temporary location used as a 
counter. 

The program begins at START. The A and_X registers are saved first. A 
major loop is repeated four times, once for each servo. Within each loop is 
another loop that times the width of the pulse being generated. When all four 
servos have been serviced, the registers are restored, and control is passed 
back to BASIC. 

A BASIC program is also provided to demonstrate how easy it is to con- 
trol the servos. This program is called SERVO DEMO and listed in Figure 
11.5. Line 1000 loads and runs the machine language program just discussed. 
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QUAD. SERVO .DRIVER 


1000 *-~---—-----2-4 2 eee eee eee ee eee 
1010 * QUAD SERVO DRIVE SYSTEM 
1020 * COPYRIGHT JAN. 1984 
1030 »% BY JOHN BLANKENSHIP 
1040 *------------~------~-----+---+------- 
1050 
1060 .OR $300 
O3FE- 1070 IRGVEC .EQ 83FE 
cos9- 1080 AN.ON .EQ $Co0s9 
coss- 1090 AN.OFF .EQ $C058 
1100 *-----~------------------+--+--+-----+-- 
0300- AX 11 1110 BEGIN LDA #START INIT IRQ VECT 
0302- 8D FE 03 1120 STA IRQVEC 
0o30S-—- AY 03 1130 LDA /START 
0307- 8D FF 03 1140 STA IRQVEC+1 
O30A- 58 1145 CLI 
O30B- 60 1150 RTS 
2160 *-------------------------------- 
O30C-— EA 1170 BASE NOP TABLE HOLDING 
e O30D- EA 1180 NOP PULSE LENGTHS 
O30E- EA 1190 NOP 
O3SOF- EA 1200 NOP 
0310- EA 1210 CNT NOP AND COUNTER 
1220 *-------~------------------------- 
0311- AS 45 1225 START LDA $45 RESTORE ACC 
0313- 48 1230 PHA SAVE A&X 
0314- 8A 1240 TXA 
0315- 48 1250 PHA 
0316- AY FF 1260 LDA @8FF 
0318- 8D 10 03 1270 STA CNT INITIALIZE 
O31B- EE 10 03 1280 AGAIN INC CNT ? WHICH SERVO 
OS31E- AD 10 03 1290 LDA CNT 
0321- c9 04 1300 CMP #4 
0323- FO 1F 1310 BEQ END 
0325- OA 1320 ASL MULT ACC *® 2 
0326- AA 1330 TAX 
0327- BD 59 CO 1340 LDA AN.ON,X TURN ON PULSE 
O32A- AE 10 03 1350 LDX CNT GET ORIG CNT 
032D- BD OC 03 1360 LDA BASE,X 
0330- DE OC 03 1370 LOOP DEC BASE,X 
0333- EA 1380 NOP 
0334- DO FA 1390 BNE LOOP 
0336- 9D 0C 03 1400 STA BASE,X RESTORE DELAY 
0339- AD 10 03 1410 LDA CNT 
033C- OA 1420 ASL MULT *2 AGAIN 
033D- AA 1430 TAX 
O33E- BD 58 CO 1440 LDA AN.OFF,X PULSE OFF 
O341- 4C 1B 03 1450 JMP AGAIN 
0344- 68 1460 END PLA RESTORE X6A 
034S5- AA 1470 TAX 
0346- 68 1480 PLA 
0347- 40 1490 RTI 


Figure 11.4 QUAD SERVO DRIVER 


be POKED. Line 2040 allows you to input the values for each servo. The 
The variables A(1) through A(4) are set equal to the addresses that data must 
numbers have overall limitations of 0 through 255, but your servos will impose 
even tighter restrictions. 

Most servos have 180 degrees of movement, although some have 90 or 
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10 REM 1! --------------------- ! 
20 REM {! SERVO CONTROL DEMO |! 
30 REM ! BY JOHN BLANKENSHIP ! 
40 REM ! ---------- 9-2 eee ! 
50 REM 
60 REM 


1030 A(4@) =» 783 

1040 PRINT CHRS ¢€4)9"BRUN QUAD .SERVO .DRIVER ML" 
2030 PRINT “ENTER VALUES FOR EACH SERVO" 

2040 INPUT B¢1),B¢(2),.8¢3),B¢4) 

20350 FOR I 2» 1 TO 4 

2060 POKE ACI),BCI) 

2070 NEXT I 

2080 PRINT : PRINT : GOTO 2040 


Figure 11.5 SERVO DEMO 


270. If the pulse sent to the servo tries to move beyond the physical limits, the 
servo will hum and vibrate slightly. This action should be avoided, especially 
for extended periods of time. Try different larger and smaller numbers until 
you find what the limits of your servos are. Each time you enter the new 
numbers, all of the servos will move (simultaneously) to their respective 
destinations. 


SUGGESTIONS FOR FURTHER STUDY 


Servos provide a near perfect basis for building a small robot arm. They are 
relatively strong, readily available, and reasonably inexpensive. As we have 
seen, they can be controlled easily with BASIC. If you performed the experi- 
ment, you also found that their movement is fast and precise. You might want 
to construct an entire arm using servos as the sole power source. Use the 
algorithms discussed in previous chapters to decide what positions the arm 
needs to move to. An arm made from small servos will not be very powerful, 
but it can be very exciting and certainly educational. 


Aa Arm 
for 3 Haad 
Puooet 


JUST FOR FUN? 


Everyone has seen, if not played with, a hand puppet. When you use a hand 
puppet, you use your hand and arm to give life to an otherwise formless ob- 
ject. The illusion of creating life is certainly an exciting experience. This can be 
verified by observing the popularity of pizza theaters and of course, Disney 
World. The robots that entertain us at such exhibitions have typically been 
powered by pneumatic controls. 

Pneumatic systems, while much cheaper than the more powerful hy- 
draulic ones, are still relatively expensive. It is also difficult to construct port- 
able pneumatic systems. Because of these limitations, several companies are 
starting to produce entertainment robots that are powered with stepper mo- 
tors. Stepper motor systems can be much smaller than their pneumatic coun- 
terparts. This means even a store chain with limited floor space can utilize 
modern technology to entertain its customers. Not only that, but a portable 
entertainment center can be easily moved from one store to another, as 
needed. 

In both pneumatic and stepper motor systems, the robots are usually 
programmed with a training session. In such a session, human operators con- 
trol the robots while a record or tape is played. A computer monitors and 
remembers the actions performed and the time they occurred. If the record is 
replayed, the computer can synchronize the original movements with the 
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sound. The robots can sway with the beat and appear to sing or talk. 
Wouldn’t it be nice to experiment with your own robot entertainment system? 


CONSTRUCTING A ROBOT PUPPET 


Building a robot entertainment center is actually much easier than you might 
think. In this chapter, I want to show you a simple, two-movement arm that 
can manipulate a hand puppet. Figure 12.1 shows the puppet system in its 
finished state. Naturally, you can buy any style puppet you wish, or even 
make one of your own. 

Figure 12.2 shows the hardware with the puppet removed. As you can 
see, I used an old cigar box for the base of the arm. The box holds a rotisserie 
motor from a grill. The square steel rod that supports the puppet slides easily 
into the motor output shaft connection. At the top of the rod is an L-shaped 
bracket that will protrude into the upper mouth of the puppet. A wooden 
lower jaw pivots on the L bracket. 

A second motor is mounted on the rod itself. I used an automobile elec- 
tric door-lock motor, so it really operates more like a solenoid than a motor. 
Actually, I had planned on using a solenoid, but I needed more power and a 
longer stroke than typical solenoids can provide. A small spring keeps the 
mouth closed. When the door-lock motor is turned on, the mouth opens and 
stays open until the motor is turned off. 


Figure 12.1 A hand puppet can come to 
life using the principles in this chapter. 
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Figure 12.2 Underneath the fuzzy exte- 
rior, the puppet is made of wood and 
metal. 


INTERFACING THE MOTORS 


In keeping with my philosophy that cheap and simple is better, I chose to use 
DC motors to power the hand puppet arm. Figure 12.3 shows the schematic 
for the interface circuit. It allows annunciators 0, 1, and 2 on the game port to 
control the motors. Since this circuit is very similar to others discussed in 
earlier chapters, I will not go into it further. 


THE SOFTWARE 


As with most robot projects, the software is the heart of the system. The soft- 
ware for the puppet project will be in two parts. The first of these parts is a 
special software clock that will let the computer know when certain events 
happen. This clock will require the interrupt circuit described in Chapter 11. 
Each time an interrupt occurs the machine language program in Figure 12.4 
will be run. Refer to the listing of that program as you read the following dis- 
cussion. 

The first portion of the interrupt timing program sets up the interrupt 
vector and enables interrupts. The main program (START) assumes that the 
first variable initialized by BASIC is an integer variable. This variable is incre- 
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ROTATION 
(son 


+5* 


LEFT/RT 


AN2 


AN1 


AN@ 


*5 volts should come 
from an external supply 


Figure 12.3 Again the Apple game connector provides all the control signals we 
need. 


mented by 1 each time an interrupt occurs. Since the interrupts occur approx- 
imately 60 times each second, BASIC programs can time events accurately 
and easily by referring to the proper variable. | 

Perhaps an example can make this clearer. First construct the interrupt 
circuit of Chapter 11, and place it in any slot. Type in the machine language 
program or BLOAD INT.TIM.SYS from the optional diskette. Then type in 
and run the following program. 


10 CALL 768 : REM ENABLE INTERRUPTS 
20 A% =0 : REM ESTABLISH FIRST VARIABLE 
30 PRINT A% : GOTO 30 


If you were to press RESET to make sure interrupts are disabled and run 
20, this program would print zeros over and over until you stop it. If you just 
RUN though, the program will print a series of numbers that are constantly 
incrementing. You can’t really use this system as a clock, but it can be used to 
determine how many counts have elapsed from a given starting time. And that 
is precisely what we need. 

Figure 12.5 contains a program called PUPPET CONTROLLER. It will 
enable you to train your puppet to perform a series of actions and then play 
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0069- 


o300- A@g9 


0302- 8D 
0305- AQ 
0O307- 8D 
O30A- 38 
O30B- 60 
O030C-— A5 
O30E- 48 
O30F- 98 


O310- 48 
O31l1- AO 


O313- Bl 
O315- 18 
O316- 69 
0318- 91 
O31A- 88 
O31B- Bl 
O31D- 69 
O31F- 91 
O3Z1- 68 
03Z22- A8 
0323- 68 
0324- 40 


TIMING.SYS 


45 


1000 
1010 
1020 
1030 
1040 
1050 
1060 
1070 
10860 
1090 
1100 
1110 
1115 
1120 
1130 
1140 
1150 
1160 
1170 
1180 
1190 
1200 
2210 
1220 
1230 
1240 
1Z30 
1260 
1270 
1280 
1290 
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® INTERRUPT TIMING SYSTEM 

® COPYRIGHT JAN 1984 

al BY JOHN BLANKENSHIP 

ee 
OR $300 


INIT LDA #*START SET UP INT VECTOR 
STA $3FE 
LDA /START 
STA S$3FF 


START LDA $45 RESTORE ACC 


LDY #$3 
LDA (LOMEM),Y GET LOW BYTE 


ADC #61 INCREMENT IT 
STA (LOMEM),Y 


LDA (LOMEM),Y GET HIGH BYTE 
ADC #60 INC IF NEC. 
STA (CLOMEM),Y 

PLA RESTORE A&X 


Figure 12.4 INT.TIMING.SYS 


those actions back. Refer to the program listing for the following discussion. 
Line 5 in the program sets up the timing variable A % as the first variable in the 
table. It also runs the interrupt program, which should already be in memory. 

Next, the addresses of the annunciators are established so POKE state- 
ments can easily control the motors. A menu lets you choose to train your 
puppet or torun the previously recorded sequence. When training takes place, 
you manually control the robot’s motions by pressing the keys indicated by 
the program. Each time a key is pressed, the next row in the two-dimensional 
array A% is updated as follows. 


A%(0) contains the present number of counts 


A%(1) contains a 1 1f ANO is to be on 
a 0 if ANO is to be off 


A%(2) same as above except for AN1 
A %(3) same as above except for AN2 


When you have completed the training session, the array will be filled 
with information concerning which motor signals should be sent and when the 
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PUPPET CONTROLLER 


5 A®%®% = 0: CALL 768 

9 DIM OUT%(200,3>) 

10 Ni = 49240:F1 #2 49241: REM OPEN/CLOSE 
20 N2 = Ni + 2:F2 = Fi + 2: REM ON/OFF 
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30 N3 = Ni + 4:F3 = Fi + 4: REM FORWARD/RE 


VERSE 
35 POKE F1,0: POKE F2,0: POKE F3,0 
40 TEXT : HOME 
5 0 PRINT "TRAIN OR RUN (T/R)D ";: GET AS: 


60 IF At&t = "T" THEN 1000 

70 IF AS = “R" THEN 2000 

80 PRINT CHRS (7): GOTO 40 

1000 REM ! ------------ 9-9" "%e%"%°%°°°-->- ! 

1010 REM ! TRAIN MODULE ! 

1020 REM !------------------------ ! 

1030 HOME 

1040 PRINT “HIT ANY KEY TO START... .THEN" 
1050 PRINT 


1060 PRINT " LEFT ARROW TO GO LEFT" 
1070 PRINT “" RIGHT ARROW TO GO RIGHT" 
1080 PRINT " SPACE BAR TO STOP" 

1090 PRINT " 1 TO OPEN MOUTH" 

1100 PRINT " 2 TO CLOSE MOUTH" 

1105 PRINT " E TO END THE TRAINING” 
1110 PRINT : PRINT 


1115 GET At®:A% = 0 

1120 IF PEEK (49132) > 127 THEN GET A$: 
1130 

1121 GOTO 1120: REM WAIT FOR KEY 


PRINT 


GOTO 


1130 FOR I #2 0 TO 3:OUTS(N + 1,19 = OUTSR(N 


-I): NEXT I:N s&s N + 1 

1140 IF AS =» "1" THEN OUT®(N,1) = 1: GOTO 
1200 

11350 IF AS = "2" THEN OUT®(N,1) 2 0: GOTO 
1200 


1160 IF A$ = CHRS (8) THEN OUTS®(N,2) = 1: 


OUT®(N,3) = 0: GOTO 1200 
1170 IF A$ = CHRS® (21) THEN OUT®(N,2) = 
:OUT®(N,3) ss 1: GOTO 1200 


1 


1180 IF AS = " “ THEN OUT®(N,2) = 0: OUTS (ON 


-3) =» 0: GOTO 1200 
1185 IF AS w» “E" THEN N = N + 1: POKE Fi, 
POKE F2,0: POKE F3,0: GOTO 40 
1190 GOTO 1120 
1200 OUT®<(N,0) = A%: REM SAVE TIME 
1250 X = N: GOSUB 3000: REM SEND TO PORTS 
1300 GOTO 1120 
2000 REM Pam em em mm mmm mmm mm mr rrr ! 
2010 REM ' RUN TRAINED SEQUENCE §! 
2020 REM f—-—- — He eH He eH me em ee eee ee eee ! 
2025 A®%® = O 
2030 FOR X = 1 TO N 


0 


2040 IF A®% ¢« OUT%(ZX,0) THEN 2040: REM WAIT 


TILL TIME 
20350 GOSUB 3000: REM SEND TO PORT 
2060 NEXT X 
2070 GOTO 40 
3000 REM f---- eH He He eH ee em ee ee ee ee ee ! 
3010 REM ! SEND ROW X TO THE PORTS |! 
3020 REM P—-—- ee ee ee ae a ae a a ae ae re er ee ee ee ! 


3030 IF OUT%(X,1)> = 1 THEN POKE N1,0: GOTO 


30350 


Figure 12.5 PUPPET CONTROLLER 
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3040 POKE F1,0 

3030 IF OUT%(X,2) = 1 THEN POKE N2,0: GOTO 
3070 

3060 POKE F2,0 

3070 IF OUT%(Z,3) = 1 THEN POKE N3,0: GOTO 
3090 

3080 POKE F3,.0 

3090 RETURN 


Figure 12.5 (cont.) 


transfer should occur. During playback of the sequence, line 2040 waits until 
the time for the next event to occur. The subroutine at line 3000 is then called 
to activate the annunciators as indicated by the array elements. 

This program is very short, and the hardware is probably the easiest in 
this book to build, but don’t sell it short. Play a record and by pressing the 
proper keys, make your puppet sing along with the music. Replay the record, 
and start the robot playback at the same point in the song. You’ll be amazed at 
how lifelike the puppet will be. After trying it once, 1t won’t take you long to 
think up interesting demonstrations of your own. For example, imagine how 
easy it would be to create your own ‘‘ventriloquist’’ act. 


SUGGESTIONS FOR FURTHER STUDY 


The most obvious extension to this project is to expand the robot manipulator 
itself. Add some ‘‘fingers’’ so that you can move the puppet’s arms. You 
might also want to allow the robot to bend at the waist or to tilt its head. If you 
get really excited about this project, you might arrange for the puppet’s eyes 
to move or his nose to wiggle. 

If you own a voice synthesizer, you might want to write a program that 
will synchronize the puppet’s movements with the computer-generated 
speech. Imagine a tutoring program for children that talks to the child by way 
of acute puppet. Believe me, your imagination will run wild once you see that 
the computer no longer has to be cold and lifeless. 


Gomouterizing 1s 
8 loyArm 


WHY USE TOYS? 


If you visit your local toy store, you will find numerous science fiction toys of 
all varieties. At the time I wrote this book, a popular toy was a small robot 
arm called Armatron. It was distributed by both Tommy and Radio Shack. 
You may still be able to buy one if you check your local stores, or you might 
even find something better. A toy arm can provide a mechanical starting point 
for the many people who do not have the time, tools, or talent to construct an 
arm from scratch. And because toy arms are mass produced, you can expect 
them to be very inexpensive. I have seen the arm used in this chapter adver- 
tised for under $25. 

Unfortunately, toy arms were never meant to be interfaced to a com- 
puter. That can be remedied, however, with a little ingenuity. My first step 
was to carefully take my toy arm apart to examine its drive components. The 
Armatron has six motions, all driven from one small motor. It is a mechanical 
masterpiece that is worth buying just to study. Mechanical clutches are used to 
allow the motor to engage different joints. Figure 13.1 shows a typical clutch 
arrangement. 

A clutch consists of a cylinder-like mechanism with a small tab pro- 
truding from the side. When a pivoting bracket is moved so that it is under a 
tab, then the clutch stops its rotation. This stopping action causes an internal 
spring arrangement to transfer the drive shaft power to an output gear. Nor- 
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REVERSE 
FORWARD CLUTCH 
CLUTCH 
hh Figure 13.1 Mechanical clutches are 
PULL FOR FORWARD used in the Armatron to transfer power 
PUSH FOR REVERSE to the various joints. 


mally, the bracket is pivoted mechanically by moving one of the joysticks on 
the front of the Armatron. What I needed was a way for the computer to move 
the pivot. 


THE MECHANICAL CONNECTION 


I connected a piece of stiff wire to the bracket and ran it out through a small 
hole in the case. Pulling or pushing on this wire activates a clutch, causing a 
joint to move either forward or reverse. In order to get both a pull and a push 
action, I used two solenoids connected as shown in Figure 13.2. A piece of 
heavy wire is used to hold the two solenoid pistons together. Solenoid 1 pro- 
vides the pull while push is obtained from solenoid 2. Figure 13.3 shows a 
photo of the actual solenoids and how they are mounted around the Armatron 

After examination of the Armatron, I was able to find ways to connect 
six solenoid pairs to control the six actions of the arm. After some trial and er- 
ror adjustments, I could activate the arm by applying power to the proper 
solenoid. 


CONTROLLING THE SOLENOIDS 


The computer can turn the solenoids on and off with the same circuits pre- 
viously used to control relays. To do so would require twelve output pins, one 


SOLENOID 
1 


SOLENOID ’ : 
9 |_| Figure 13.2 Two solenoids provide both 


a push and a pull action, as required. 


ARMATRON 
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Figure 13.3. Twelve solenoids (six pairs) 
provide the link between the computer 
and the Armatron. 


for each solenoid. Since we never need to pull and push any given wire at the 
same time, I devised an interface that can be driven from one 8-bit port. This 
circuit is shown in Figure 13.4. The two most significant bits are used to con- 
trol the action as indicated below. 


bit 7 bit 6 action 


0 0 all solenoids off 

0 | indicated PUSH solenoids ON 
| 0 indicated PULL solenoids ON 
1 | not used (remember last state) 


The last state (1,1) 1s normally not used. The cross-coupled NAND gates 
use this state to ensure that the computer will not accidentally try to simultane- 
ously turn on both solenoids in a push/pull pair. 

When the bits are 0,0, then no solenoids can be turned on, either PUSH 
or PULL. The 0,1 and 1,0 states enable the PUSH and PULL actions respec- 
tively. When one of these modes has been selected, then the six least signifi- 
cant bits decide or indicate which solenoid pair will be enabled. The bit assign- 
ments I used are as follows: 


bit assignment 


wrist up and down 

wrist right and left 

hand open and close 
arm up and down 

arm left and right 

wrist rotate left and right 


aA bh WN — © 
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MSB 
1 AL a 


WRIST UP/DOWN 


WRIST RIGHT/LEFT Ho 


TOTAL 12 
is TRANSISTORS 
L ° DRIVING 12 
ro SOLENOIDS 
a. 
ad 
> 
F _HAND OPEN/CLOSE - 
: ihe 
: = 
a ) e 
a. 
< 
ARM UP/DOWN Ho 
ARM RIGHT/LEFT Ho 
WRIST ROTATE 3 
iso 


Figure 13.4 This circuit is used to drive the solenoids from an 8-bit output port. 
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While it is possible to turn on several actions simultaneously (as long as 
they are all PUSH or all PULL), I chose to activate only one at a time. The 
following decimal codes can be sent to the output port to perform the action 


indicated. 
Code Action 

129 Wrist up 

130 Wrist right 

132 Hand close 

136 Arm up 

144 Arm left 

160 Wrist clockwise 
65 Wrist down 
66 Wrist left 
68 Hand open 
72 Arm down 
80 Arm right 
96 Wrist counterclockwise 


SENSORY FEEDBACK 


Now that the computer can move the Armatron, we need some means for the 
computer to read the position of each of the joints. I mounted potentiometers 
on each joint using gears, foam rubber, and silicone glue. I also added micro- 
switches on the hand to give a sense of touch. Mercury switches can be used to 
indicate the tilt of the arm. Figures 13.5 and 13.6 show details of these pots 
and switches. 


Figure 13.5 Potentiometers and mercury switches provide absolute positional in- 
formation. Only the potentiometers are used in the demonstration program pro- 
vided. 
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Figure 13.6 Micro switches mounted on 
the hand can be read to provide a sense 
of touch. 


DESIGNING THE SOFTWARE 


The program to control a toy arm like the Armatron presents some special 
problems. Some of the problems occur because the computer cannot control 
the speed as the joints move. As you recall from Chapter 10, this inability can 
cause overshoots and oscillations. Other problems arise because the computer 
can only turn on one joint at a time. Both of these situations can be overcome 
with some creative programming. 

Figure 13.7 shows the main flowchart for the program. After initializa- 
tion, the program reads the number of points from a DATA statement. This 
information is used to set up a FOR loop that reads four pot readings from the 
next DATA statement. If we assume we have a module that will move the four 
major joints to a point where all the pots match the DATA readings, then the 
chart is complete. So far this chart is not unusual. 

The expansion of the Move to Point module, however, is a little more 
creative. Figure 13.8 shows the details of this chart in a simplified manner. 
Each time the arm is requested to move to a point, it will do so in five steps. 
Earlier in the program the array C was set to the following numbers: 


C(1) = 150 
C(2) = 90 
C(3) = 40 
C(4) = 15 
C(5) = 3 


The first time through the loop, all pots will be moved to within 150 of 
their correct reading. The second time through will ensure that all pots will be 
within 90. By the end of the fifth loop, each pot should be at its expected 
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READ 4 
VALUES 


MOVE ALL 
4 JOINTS 
TO THOSE 
VALUES 


NEXT | 


MOVE EACH 
JOINT TO 
WITHIN 
C(L) OF 

DESTINATION 


NEXT L 
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Figure 13.7 A simple loop is used to 
move the arm to each point in sequence. 


Figure 13.8 The actual MOVE TO 
POINT module is expanded here. All 
four joints are moved a little closer with 
each pass through the loop. 


destination, plus or minus 3. Think about how this will affect the arm’s move- 
ment. Each joint, in turn, will move a little closer to the final position. It will 
almost look like all the joints are moving at once. The motion of the hand will 
be relatively smooth over the path being traveled. 

The hand will move shorter and shorter distances as it approaches the 
destination point. These shorter distances will mean that the arm will not be 
able to get up to full speed, which means that the danger of overshoot will be 
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ARMATRON . CONTROLLER 


=» 12 * 4096 + 256 + 1+ 8 *® 16 


20 DD » D+ 2 


22 
23 
z4 
zs 


80 
100 
1000 
3010 
1020 
1025 
1030 
1040 
1050 
z2000 
2010 


z2020 
2030 
2040 
3000 
3010 


3020 
3030 
3040 
6000 
@€010 


6020 
6030 
6040 
7000 
7010 


7020 
7030 
7040 
6000 
1000 
1000 


1001 
1002 
1003 
1004 


POKE DD,255: POKE D,0 
FOR I xs 1 TO 5 
READ C(I): NEXT I 
DATA 13530,80,40,15,3 
REM THE ABOVE DATA DETERMINES HOW CLOSE 
REM EACH JOINT COMES ON SUCCESSIVE TRIES 
READ NP 
FOR I «= 1 TO NP 
PRINT “GOING TO POINT NUMBER "I 
FOR J = 1 TO 4 
READ P¢J) 
NEXT J 
GOSUB 1000: REM GOTO POINT 
NEXT I 
END 
REM GOTO POINT 


FOR L 2» 1 TO 3: REM 5S SUCCESSIVE STEPS 

FOR K = 1 TO 4: REM 4 JOINTS 

ON K GOSUB 2000,3000,6000,7000 

NEXT K 

NEXT J 

RETURN 

REM WRIST UP/DOWN 

IF ABS ¢(P¢(1) - PDL ¢3)) ¢ CCL) THEN POKE D,0O 
RETURN 


IF PDL (3) >» P(1) THEN POKE D,128 
IF PDL (3) ¢ P(1) THEN POKE D,65 
GOTO 2010 


REM WRIST LEFT/RIGHT 
IF ABS (P(2) - PDL ¢(2)) ¢ CCL) THEN POKE D,0 
RETURN 


IF PDL (2) > P(2) THEN POKE D,130 


IF PDL (2) ¢ P(2)> THEN POKE D,66 

GOTO 3010 

REM ARM LEFT/RIGHT 

IF ABS (P¢€3) - PDL ¢1)) ¢ CCL) THEN POKE D,0O 
RETURN 


IF PDL (1) > P(3) THEN POKE D,80 
IF PDL (1) ¢ P¢3) THEN POKE D,144 
GOTO 6010 
REM WRIST ROTATE 
IF ABS (P¢(4@) - PDL (0)) ¢ CCL) THEN POKE D,0 
RETURN 
IF PDL ¢0) >» P(4) THEN POKE D,9#6 
IF PDL ¢0) ¢ P(4) THEN POKE D,160 
GOTO 7010 
RETURN 
o DATA 4: REM NUMBER OF POINTS 
5 REM EACH POINT CONSISTS OF THE PDL READINGS O 
F EACH JOINT 
0 DATA 1980,1,85,61 
0 DATA 121,71,121,61 
0 DATA 176,254,42,169 
Q DATA 137,38,237,63 


Figure 13.9 ARMATRON CONTROLLER 
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greatly reduced. If you try this experiment, I think you will be impressed at 
how well you can move the arm using only the crude ON/OFF capabilities of 
the solenoids. 

The coding of these flowcharts can be found in Figure 13.9 and on the 
optional diskette as the ARMATRON CONTROLLER. Compare the coding 
to the flowcharts if you wish to explore this area further. 

No matter what toy arm you find to automate, you should be able to ap- 
ply the principles discussed in this chapter. Naturally, if you can find an arm 
that will permit speed control, or the use of stepper motors, then you can 
utilize the information found in other chapters of the book too. The point to 
remember is that toy arms can provide a very economical mechanical system 
to serve as a basis for building your computerized arm. 


SUGGESTIONS FOR FURTHER STUDY 


Moving the arm from point to point, as we have done here, is just the begin- 
ning. The next step is to connect the sense switches, discussed earlier, to an in- 
put port. Properly placed switches can tell the computer when an object is in 
the hand. Other switches can indicate when the hand hits an improperly 
placed object while descending. My mercury switches can indicate two posi- 
tions of the main arm. One of these positions is just right for picking up ob- 
jects, while the other is perfect for stacking one block onto another. 

If you have similar sense switches on your arm, then you can develop 
software for a long time before you master all the capabilities that a toy arm 
can provide. An interesting project would be to convert the Blocks World pro- 
gram of Chapter 3 for use with a jointed arm. Such a project would require 
you to combine all of the knowledge covered throughout this book. If you 
have actually performed all of the experiments so far, then I have no doubt 
that you will be up to the task. 


4 


Man-Sizeo 
Arms 


THE END OR THE BEGINNING? 


We’re at the end of the book, but if you are a true robot enthusiast, then your 
experimenting is just beginning. In the previous chapters, I have tried to ex- 
plore many aspects of robotics. We have experimented with simulations 
(Chapters 2 and 6), artificial intelligence (Chapter 3), and computer vision 
(Chapter 5). 

Our examination of motor control has been thorough. We have con- 
trolled both the speed and position of DC motors (Chapters 4 and 10). Pro- 
grams have been developed to utilize inexpensive hobby systems (Chapters 11 
and 13). Not only have we seen how to control a stepper motor, but how to 
control several steppers at the same time to allow a path following (Chapters 8 
and 9). We have even controlled the movements of a puppet in order to give 
the illusion of life (Chapter 12). 

Yes, we’ve done all this, and the experiments are still just beginning. 
Most robot enthusiasts want more than just the knowledge of controlling 
‘‘toy”’ or “‘educational’’ robots like those covered so far. They want to build 
man-sized arms that can do useful work. Such dreams are very exciting, but all 
too many robot builders start with more enthusiasm than knowledge. That’s 
precisely why I wrote this book. The experiments have been designed to pro- 
vide you with the skills and information needed to reach your goals and to 
provide these skills and information at the lowest possible cost. 
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If you have studied and performed all of the previous experiments and 
suggestions for further study, then you should be prepared to design and build 
a ‘‘real’’ robot arm. I suppose I could have ended this book here and left you 
to begin your own man-sized robot. But I don’t think this book would be 
complete without offering some suggestions to help you start in the right 
direction. I’ve only just begun my experimentation in this area, and I hope 
some of my experiences can help you. 


DEGREES OF FREEDOM 


One of the first decisions you will need to make is how many degrees of 
freedom your robot will have. Degrees of freedom loosely translates into the 
number of joints. At least three degrees of freedom are required to position 
the end point of the arm itself. If the hand or manipulator also has three 
degrees of freedom then the hand can orient itself in any position at any 
desired point. Many applications can be handled with only a total of five or 
even four degrees of freedom. Examine your needs carefully. Each additional 
degree of freedom adds much more cost than the last. This is true because pre- 
vious joints must be strengthened to handle the added weight of a new joint. 

No matter how many degrees of freedom your arm has, you will also 
need to decide how it will move through its work area. Figure 14.1 will help 
clarify what I mean by showing four ways to make an arm with three degrees 
of freedom. Part A of this figure shows a typical arm. It has an elbow and a 
shoulder, and it can rotate around its base. There are several problems with 
such an arm. First, the trigonometry to calculate the arm’s position is more 
difficult than some hobbyists want to pursue. Actually, the math is not really 
that bad, if you understood everything in Chapter 7. 

The second problem with this type of arm is more difficult to overcome. 
The work space is spherical in nature, and while it may seem large at first, it 
can turn out to be quite small. For example, if your arm’s task is to manipu- 
late the pieces on a 14-inch square chess board, then the arm will need to be 
about 20 inches long. Many things will affect the actual length, but generally, 
you will find this arm very inefficient if the work area is square. 

A third problem with this arm deals with the interaction of the joints. 
Suppose, for example, that you move the hand over an object in the work 
area. If you descend the arm by just moving the shoulder joint then the hand 
will get closer to the base. In addition, 1f the wrist joint is fixed, then it will tilt 
as the arm descends. A similar problem occurs when rotating the base to move 
the hand sideways. The hand will not only move closer to the back of a square 
work area, but orientation of the hand (relative to the square work area) will 
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(a) (b) 


HAND 


HAND 


(c) (d) 


Figure 14.1 The joints of an arm can take many configurations. 


change. Naturally, a little math can solve most of these problems relatively 
easily. A little planning, however, can reduce the amount of math needed con- 
siderably. 

Part B of Figure 14.1 shows an alternate joint design. In this case, the 
hand can be raised and lowered without affecting any other joint. Part C 
shows a design that moves totally through the use of Cartesian coordinates. 
The software for this robot would be much simpler than either of the previous 
two. Unfortunately, it too has its disadvantages. Such an arm tends to be very 
bulky, with ‘‘tracks’’ for each of the joints protruding behind them. Special 
equipment is also often required to build this type of arm. 


MAKING COMPROMISES 


Figure 14.1 D shows my choice for a hobbyist arm. It combines the best fea- 
tures from each of the other alternatives. A shoulder and elbow are used be- 
cause they are the easiest form to construct. This entire assembly, however, 
can be moved horizontally along the work area. Notice that the orientation of 
the hand is not affected as the arm moves laterally. True, trigonometry must 
be used to control movements away from the base, but these calculations in- 
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volve only one plane. Since no three-dimensional trigonometry is used, the 
math discussed in Chapter 9 will handle every situation for positioning the end 
of the arm. A similar set of equations could be applied to the hand itself to 
determine orientation. 

Naturally, you will have to select your design based on your particular 
needs. This arm, by its very nature, has a work area that is square. I prefer this 
design because most of the problems I want a robot to solve involve a square 
work area. Figure 14.2 shows how I obtained the linear motion for the base. 
Essentially, a wooden box is mounted on two steel rods using brass tubes as 
bearings. A motor turns a threaded rod that pulls and pushes the movable sec- 
tion to its destination. I mounted small wheels on the bottom of the movable 
box to help support its weight. The steel rods only serve to keep the box from 
tilting forward. If the arm is counter balanced, then this tilting force is mini- 
mized. 

Figure 14.3 shows the details of the shoulder and elbow joints. I used 
aluminum channel, from a local hardware store, to construct the arm sec- 
tions. Standard hinges were used to form the joints. Since I wanted the arm to 
be able to lift reasonably heavy objects, I decided to use a lead screw mechan- 
ism to position each joint. Lead screws can be made using threaded rods and 
tapped stock, but I found an easier solution. Figure 14.4 shows a screw jack 
used on aircraft. These jacks are available from many surplus houses and are 
perfect for robotic use. When a motor is attached to the gear end of the jack, a 
linear motion results as the opposite end moves on an internal threaded rod. 

Figure 14.5 shows how I connected a motor to the screw jack. The motor 
is supported by a small metal bracket. The motor shaft is actually connected 
to the jack using rubber tubing. Before you laugh at my use of tubing here, let 
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Figure 14.2 My man-sized arm moves its base with a linear motion. 
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Figure 14.3 Aluminum channel and 
hinges are the primary material used to 
construct the arm itself. 


Figure 14.4 Using a surplus screw jack 
is easier than constructing your own lead 
screw assembly. 


me tell you that I have lifted in excess of 15 pounds with this arrangement, 
with no signs of slipping. The tremendous gear ratio of the jack requires very 
little torque at its input shaft. The rubber tubing is also very forgiving if the 
mounting is not exactly centered. 


DESIGNING THE MANIPULATOR 


With the arm detail finished, we can turn to designing a manipulator. A good 
hand is very important, so give it the attention it deserves. Figure 14.6 shows 
several possible hand designs. Part A of this figure shows a very simple design. 
Two pivoting fingers are held open by springs, and a cable is used to pull them 
closed. Parts B and C show how gears may be used to provide a more solid 
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Figure 14.5 A motor is easily connected 
to the screw jack. 


closing action. In all three of these designs, though, the ends of the fingers 
must be round. This is true because the finger tips will not remain parallel as 
the hand closes. 

Parts Dand E of Figure 14.6 show how to keep the fingers parallel. Four 
equal-length connecting struts ensure that the fingers have to maintain the 
same Orientation throughout their travel range. Many possible power arrange- 
ments can be made to this type of design. I have found it very worthwhile to 
build working models of complicated devices like a hand. A model can help 
you find problems before you have spent a lot of time and money on your 
final construction. Figure 14.7 shows a sample prototype hand that I made 
from balsa wood. 

Figure 14.8 shows an entirely different approach to building a hand. I cut 
a turnbuckle as shown in the figure. Note that a turnbuckle has two bolts, one 
with left and one with right-hand threads. The resulting pieces (marked A and 
B) were bent and reinforced with epoxy to form the fingers. The eye of the 
left-handed bolt was cut off and replaced with a nut epoxied in place. The 
right-handed bolt was discarded and replaced with a longer bolt to make room 
to epoxy a gear to its end. 

The two bolts are fastened together to form one. Turning this shaft in 
opposite directions causes the fingers to open and close. The major advantage 
offered by this hand, over those in Figure 14.7 D and E£, is that the fingers do 
not lengthen as the hand closes. 


(e) 


Figure 14.6 Robot manipulators can take many forms. 


Figure 14.7 Balsa wood models can 
help you find problems before you 
spend time and money building your fi- 
nal version. 
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Figure 14.8 An aluminum turnbuckle is the basis for this unusual hand. 


DESIGNING THE WRIST 


The wrist is important because it provides the means to orient the hand. Some 
applications may not require the wrist to be movable. If, for example, the 
robot was designed only to stack blocks, then the hand should remain vertical 
at all times. Figure 14.9 shows how a cable and pulley arrangement can be 
used to keep the hand at the same orientation, regardless of the position of the 
shoulder and elbow joints. A hand of this type requires much simpler software 
than a hand with more freedom. 

Figure 14.10 shows a method for achieving both tilt and rotation for a 
hand. Another method, and one I prefer, is shown in Figure 14.11. Either 
sprocket or bevel gears are arranged to give both tilt and rotation. When gears 
A and B are both turned in the same direction, the hand tilts. When gears A 
and B are turned in opposite directions, then the hand will rotate. Figures 
14.12 and 14.13 show a wrist and hand that I am experimenting with. The en- 
tire arm is shown in Figure 14.14. 
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Figure 14.9 The proper pulley arrange- 
ment can keep a hand in a permanent 
vertical orientation. 


Figure 14.10 A wrist gets complicated as more degrees of freedom are added. 


ARM 


SPROCKET 


Figure 14.11 An alternate approach for wrist design employs sprocket or bevel 
gears. 


BEVEL GEARS 


Figure 14.12 Two stepper motors drive 
sprocket gears to create a wrist with 
both tilt and rotation. 
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Figure 14.13 My turnbuckle hand is 
driven by a small DC motor. 


Figure 14.14 My man-sized arm in the 
final stages of development. 


SUGGESTIONS FOR FURTHER STUDY 


I hope I have given you the background you need to design and build an arm 
to handle whatever tasks you might desire. Customize your arm with as many 
senses as necessary to permit proper interaction with its environment. If you 
have no real tasks for an arm to do, then build a small lightweight arm that can 
be used to perform more detailed educational experiments than the ones we’ve 
done so far. Remember, most of my experiments dealt with only one aspect of 
robotics at a time. Many new experiments can be performed by just combin- 
ing two or more of the principles that we have explored in previous chapters. 
If you enjoy programming, then the addition of a robot arm to your computer 
can provide you with a seemingly endless supply of new ideas. Ideas that can 
keep you busy, and excited, for many years to come. 


SOURCES 
for Robot 
Paris 


Each of the following firms offers parts and catalogs that you might find use- 
ful when experimenting with robotics. The list is not intended to be complete. 
It only reflects those firms that I have used or come in contact with. For other 
sources, examine the ads in magazines that relate to electronics, microcom- 
puters, and hobby robotics. 


Gears and other precision parts 


Small Parts Inc. Winfred M. Berg Inc. 
6901 N.E. Third Ave. 499 Ocean Ave. 
P.O. Box 381736 East Rockaway, L.I., NY 11518 


Miami, Florida 33138 


Surplus equipment (including motors, screw jacks, relays, switches, 
wheels, reading pacers, and so on) 


H & R Corporation Surplus Center 

401 E. Erie Ave. 1015 West ‘*O’’ Street 

Philadelphia, PA 19134 P.O. Box 82209 
Lincoln, NE 68501 

Jerryco Deltroniks, Inc. 

601 Linden Place 5151 Buford Hwy. 

Evanston, Illinois 60202 Atlanta, GA 30340 
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For those readers who would prefer not to spend their weekends typing in the 
programs found in Robotic Projects, you may receive the programs on 


diskette by sending $19.95 to: 
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John Blankenship 
P.O. Box 47934 
Atlanta, GA 30362 


A catalog of the diskette is shown below. 
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002 
036 
045 
004 
002 
002 
006 
010 
013 
006 
002 
007 
016 
017 
005 


ROBOTIC ARMS AND MANIPULATORS 


X-Y VIDEO SIMULATOR 
BLOCKS WORLD 

REV. COUNTER 
REV.COUNTER.ML 
COUNT.TEST 
XY.PLOT.DEMO 
VISION.1 

VISION.2 
HIRES.SCRN.FUNCTION 
HIRES.SCRN.FUNCTION.ML 
MANUAL.JOINTED 
INTEL. JOINTED 
STEP.MOTOR.ARM 
POS.CONTROL 
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| 005 QUAD.SERVO.DRIVER 
B 002 QUAD.SERVO.DRIVER.ML 
A 004 SERVO DEMO 
| 004 INT.TIMING.SYS 
B 002 INT.TIMING.SYS.ML 
A 007 PUPPET CONTROLLER 


All source code files (I) are in S-C Macro Assembler Format. Binary files are 
included, so the S-C Macro Assembler is not needed unless you wish to 
modify the source code. 


plell/Te 
Robotic Arm Projects 
John Blankenship 


In this intriguing new book, John Blankenship shows you how to create inexpensive 
robotic arms and manipulators. The author goes beyond the step-by-step instructions to 
help you understand clearly, not only by imitating his examples, but by expanding and 
changing the projects to suit your own ideas. His aim is to give you the basic principles 
by working through down-to-earth projects and then have you go on to create your own 
designs. 


The last project in this absorbing book is the challenge of constructing a human-sized 
arm. The author guides you to a point where you must resolve the final implementation 
yourself. You will focus all of the theory and experimentation you have learned on this 
exciting project. 


Even if you don’t have the time or motivation to build a real robot arm, you can still try 
many of the experiments in this book. Simulation programs are provided that create arms 
on your Apple screen. These simulations can be controlled by the same programs used 
to manipulate the real arms. 


Also by John Blankenship... 
THE APPLE HOUSE 


Yours can be the first APPLE house on the block! 


Here is a book that will show you how to save time and money by using your computer to 
control your home: the security, the lights, the heat, the telephone, and much more. 


With John Blankenship’s system, your house can accept verbal commands and respond 
with its own voice. It does not need human instruction and performs many useful tasks 

on its own. Once you get used to an intelligent house you will wonder how you ever got 

along without one. 


Published 1984 160 pages 


PRENTICE-HALL, INC. 
Englewood Cliffs, N.J. 07632 


ISBN 0O-13-0383c4-4 


